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[NAME OF DOCUMENT] SPECIFICATION 

[TITLE OF THE INVENTION] CONTROL DEVICE AND GAIT GENERATION 
DEVICE OF LEGGED MOBILE ROBOT 

[CLAIMS] 

[Claim 1] 

A control device of a legged mobile robot adapted to 
sequentially determine instantaneous values of a desired motion 
and a desired floor reaction force of a legged mobile robot that 
travels by moving legs extended from its body by using a dynamic 
model that expresses a relationship between at least a motion 
of th6^ robot and a floor reaction force, and also to control an 
operation of the robot at the same time so as to make the robot 
follow the determined instantaneous values of the desired motion 
and the desired floor reaction force, comprising: 

permissible range setting means for setting a permissible 
range of a restriction object amount, the restriction object 
amoum: being a vertical component of a floor reaction force moment 
or a C(";mponent of the floor reaction force moment in floor surface 
normal, line direction to be applied to the robot or a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot; and 

desired instantaneous value determining means for 
determining, on the basis of at least a difference between a 
desired state amount related to a posture of the robot about a 
vertical axis or about a floor surface normal line axis and an 
actual state amount of the robot and the permissible range, 
instantaneous values of the desired motion and the desired floor 
reaction force such that a deviation between a floor reaction 
force moment balancing with the desired motion on the dynamic 



model and a floor reaction force mom€?nt of the desired floor 
react.Lon force approximates the difference to zero, while having 
the restriction object amount, which is associated with the 
desired floor reaction force, fall within the permissible range. 
[Claim 2] 

Tne control device of a legged mobile robot according to 
claim 1, wherein the desired ins tantameous value determining 
means comprises 

means for determining a reference instantaneous value of the 
desired motion, 

means for determining a compensating floor reaction force 
moment, which is an additional floor reaction force moment for 
approximating the difference to zero on the basis of the 
di f f ejrence , 

means for determining a provisional value of the restriction 
object amount which is associated with a provisional 
instantaneous value of the desired floor reaction force on the 
basis of at least a floor reaction force moment that balances 
with the reference instantaneous value on the dynamic model and 
the compensating floor reaction force moment, 

means for defining a floor reaction force moment 
corresponding to a restricted restriction object amount obtained 
by limiting the provisional value of the restriction object 
amount to the permissible range as an floor reaction force moment 
instantaneous value of the desired floor reaction force, and 

means for determining a correction amount of the reference 
instantaneous value on the basis of the determined floor reaction 
force moment instantaneous value, the floor reaction force 
moment that balances with the reference instantaneous value on 
the dynamic model and the compensating floor reaction force 



moment, and determining the instantaneous value of the desired 
motion by correcting the reference instantaneous value with the 
determined correction amount. 
[Claim 3] 

The control device of a legged mobile robot according to 
claim 2f wherein the means for determining the provisional value 
of the restriction object amount comprises means for determining 
a model correction floor reaction force moment, which is an 
additional floor reaction force moment for approximating a state 
amount of the dynamic model to a predetermined state amount, and 
determines the provisional value of the restriction object 
amount on the basis of at least the floor reaction force moment 
that balances with the reference instantaneous value on the 
dynamic model and the compensating floor reaction force moment, 
the compensating floor reaction force moment, and the model 
correction floor reaction force moment. 
[Claim 4] 

The control device of a legged mobile robot according to 
claim 2 or 3, wherein the correction amount of the reference 
instantaneous value is a correction amount of a motion that 
changes a vertical component or a component in floor surface 
normal line direction of the angular momentum changing rate of 
the robot. 

[Claim 5] 

The control device of a legged mobile robot according to 
claim 4, wherein the motion that changes the vertical component 
or the component in floor surface normal line direction of the 
angular momentum changing rate of the robot is a motion of a body 
of the robot and/or an arm extended from the body of the robot. 

[Claim 6] 



A control device of a legged mobile robot adapted to 
sequentially determine an instantaneous value of a desired 
motion of a legged mobile robot that travels by moving legs 
extended from its body by using a dynamic model that expresses 
a relationship between at least a motion of the robot and a floor 
react:_on force, and also to control an operation of the robot 
at th€^ sam.e time so as to make the robot follow the determined 
instantaneous value of the desired motion, comprising: 

permissible range setting means for setting a permissible 
range of a restriction object amount, the restriction object 
amount being a vertical component of a floor reaction force moment 
or a component of the floor reaction force moment in floor surface 
normal line direction to be applied to the robot or a vertical 
component or a component in floor surface normal line direction 
of an angijlar momentum changing rate of the robot; 

compensating floor reaction force moment determining means 
for determining a compensating floor reaction force moment, 
which is an additional floor reaction force moment for bringing 
a difference between a desired state amount related to a posture 
of the robot about a vertical axis or a floor surface normal line 
axis cind an actual state amount of the robot close to zero on 
the basis of at least the difference; and 

desired instantaneous value determining means for 
determining an instantaneous value of the desired motion such 
that the restriction object amount corresponding to the sum of 
a floor reaction force moment balancing with the desired motion 
on thes dynamic model and the compensating floor reaction force 
moment falls within the permissible range, 
[Claim 7] 

The control device of a legged mobile robot according to 



claim 6, further comprising means that: defines the sum of the 
floor reaction force moment balancing with the desired motion 
on the dynamic model and the compensating floor reaction force 
moment, as a desired floor reaction force moment, and controls 
the of>eration of the robot so as to make the robot follow the 
desir€?d floor reaction force moment. 
[Claim 8] 

Tlie control device of a legged mobile robot according to 
claim 6 or 7, wherein the desired instantaneous value determining 
means determines an instantaneous value of the desired motion 
by adjusting a motion that changes a vertical component or a 
component in floor surface normal line direction of an angular 
momentum changing rate of the robot among motions of the robot 
in orcer to hold the restriction object amount corresponding to 
nhe sum of the floor reaction force moment balancing with the 
desired motion on the dynamic model and the compensating floor 
reaction force moment, within the permissible range. 
[Claim 9] 

Tne control device of a legged mobile robot according to 
claim 8, v;herein the motion that changes a vertical component 
or a component in floor surface normal line direction of an 
angular momentum changing rate of the robot is a motion of a body 
of the robot and/or an arm extended from the body. 

[Claim 10] 

A control device of a legged mobile robot adapted to 
sequentially determine an instantaneous value of a desired 
motion of a legged mobile robot that travels by moving legs 
extended from its body by using a dynamic model expressing at 
least a relationship between a motion of the robot and a floor 
reaction force, and also to control an operation of the robot 



at th6? same time so as to make the robot follow the determined 
instantaneous value of the desired motion, comprising: 

permissible range setting means for setting a permissible 
range of a restriction object amount, the restriction object 
amoun^: being a vertical component of a floor reaction force moment 
or a component of the floor reaction force moment in floor surface 
normal line direction to be applied to the robot or a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot; 

reference instantaneous value determining means for 
sequentially determining a reference instantaneous value of the 
desired motions- 
compensating floor reaction force moment determining means 
for determining a compensating floor reaction force moment, 
which is an additional floor reaction force moment for bringing 
a dif ierence between a desired state amount related to a posture 
of the robot about a vertical axis or a floor surface normal line 
axis and an actual state amount of the robot close to zero on 
the b<.isis of at least the difference; and 

desired instantaneous value determining means for defining 
a portion of the sum of the floor reaction force moment balancing 
with the reference instantaneous value of the desired motion on 
the dynamic model and the compensating floor reaction force 
momen-, which deviates from the permissible range as a moment 
correction manipulated variable, and determining an 
instantaneous value of the desired motion by correcting the 
reference instantaneous value of the desired motion with the 
momen- correction manipulated variable. 
[Claim 11] 

The control device of a legged mobile robot according to 



claim 10, wherein the desired instantaneous value determining 
means determines an instantaneous value of the desired motion 
by determining a correction amount of the reference 
instantaneous value of the desired motion on the basis of a result 
obtained by passing the moment correction manipulated variable 
rhroucjh a low-pass filter, and then by correcting the reference 
instantaneous value on the basis of the determined correction 
amount . 

[Claim 12] 

The control device of a legged mobile robot according to 
claim 10, further comprising means for defining, as a desired 
floor reaction force moment, a floor reaction force moment 
obtained by limiting the sum of a floor reaction force moment 
balancing with the reference instantaneous value of the desired 
motion on the dynamic model and the compensating floor reaction 
force moment to the permissible range, and for controlling an 
operation of a robot so as to make the robot follow the desired 
floor reaction force moment. 

[Claim 13] 

Trie control device of a legged mobile robot according to any 
one of claims 10 to 12, wherein the desired instantaneous value 
determining means determines an instantaneous value of the 
desired motion by correcting a motion for changing a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot on the basis 
of a reference instantaneous value of the desired motion. 

[Claim 14] 

Tne control device of a legged mobile robot according to any 
one o? claims 1 to 13, wherein the state amount related to a 
posture of the robot includes a yaw angle or a yaw angular velocity 



of the body of the robot. 
[Claim 15] 

The control device of a legged mobile robot according to any 
one ot claims 1 to 14^ further comprising slippage determining 
means for determining occurrence of a. slippage of the robot, 
wherein the permissible range setting means variably sets the 
permissible range according to a determination result of the 
slippcage determining means. 
[Claim 16] 

A gait generation device that generates a desired gait of 
a legged mobile robot that travels by moving a plurality of legs 
extended from its body, comprising: 

permissible range setting means for setting a permissible 
range of a restriction object amount, the restriction object 
amount: being a vertical component of a floor reaction force moment 
or a component of the floor reaction force moment in floor surface 
normal- line direction to be applied to the robot or a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robots- 
provisional instantaneous value determining means for 
determining a provisional instantaneous value of a desired 
motion constituting the desired gait; 

model calculating means that inputs at least a provisional 
instantaneous value of the desired motion to a dynamic model 
representing a relationship between a motion of the robot and 
the restriction object amount, and then determines an 
instantaneous value of a model restriction object amount as an 
output of the dynamic model; and 

desired instantaneous value determining means for 
determining an instantaneous value of the desired motion by 



f.":or rec:t.inq a provisional instantaneous value of the desired 
motion such that at least the instantaneous value of the model 
restriction object amount falls within the permissible range. 
[Claim 17] 

Tne gait generation device of a legged mobile robot according 
to claim 16, wherein the desired instantaneous value determining 
means determines a floor reaction force instantaneous value 
corresponding to a restriction object amount substantially 
balancing with an instantaneous value of the desired motion on 
the dynamic model as an instantaneous value of a desired floor 
reaction force constituting the desired gait. 
[Claim 18] 

Tne gait generation device of a legged mobile robot according 
to claim 16 or 17, wherein the desired instantaneous value 
determining means comprises: 

a perturbation model representing a relationship between a 
perturbative motion of the robot and a perturbative portion of 
the restriction object amount; 

means for determining a perturbation model manipulated 
variable for manipulating the perturbative portion of the 
restriction object amount of the perturbation model on the basis 
of at least the instantaneous value of the model restriction 
objec:i amount and the permissible ranges- 
means for determining a correction amount of the desired 
motion by supplying the determined perturbation model 
manipulated variable to the perturbation model; and 

means for determining an instantaneous value of the desired 
motion by correcting a provisional instantaneous value of the 
desired motion by using the correction amount. 
[Claim 19] 



Thct gait generation device of a legged mobi le robot according 
to claiim 18, wherein the means for determining the perturbation 
model manipulated variable comprises means for determining, on 
the basis of at least the instantaneous value of the model 
restriction object amount determined by the model calculating 
means, an estimated value of the restriction object amount in 
a case where the perturbation model manipulated variable is 
assumed to be zero, and means for comparing the determined 
estimated value with the permissible range to determine, on the 
basis of the comparison, a restricted restriction object amount 
that has been restricted to fall within the permissible range, 
and determines the perturbation model manipulated variable on 
the basis of at least a difference between the instantaneous value 
of the model restriction object amount determined by the model 
calculating means and. the restricted restriction object amount. 
[Claim 20] 

The gait generation device of a legged mobile robot according 
to claim 18, further comprising: 

means for determining a required value of the perturbation 
model manipulated variable on the basis of at least a state amount 
of the perturbation model, 

wherein the means for determining the perturbation model 
manipulated variable determines a perturbation model 
manipulated variable to be supplied to the perturbation model 
on th€^ basis of the instantaneous value of the model restriction 
object amount, the permissible range, and the required value. 

[Claim 21] 

The gait generation device of a legged mobile robot according 
to claim 18, wherein the means for determining a required value 
of the perturbation model manipulated variable sequentially 

- 10- 



determines the required value according to a feedback control 
law on the basis of a difference between a state amount of the 
perturbation model and a desired value relative to the state 
amount . 

[Claim 22] 

Tlie gait generation device of a legged mobile robot according 
to claim 20 or 21, wherein the means for determining the 
perturbation model manipulated variable comprises means for 
determining an estimated value of the restriction object amount 
in a case, where the perturbation model manipulated variable is 
assumed to agree with the required value, on the basis of at least 
the instantaneous value of the model restriction object amount 
determined by the model calculating means and the required value, 
and means for comparing the determined estimated value with the 
permissible range to determine, on the basis of the comparison, 
a restricted restriction object amount that has been limited to 
the permissible range, and determines the perturbation model 
manipulated variable on the basis of at least a difference between 
the instantaneous value of the model restriction object amount 
determined by the model calculating means and the restricted 
restriction object amount. 
[Claim 23] 

The gait generation device of a legged mobile robot according 
to claim 19 or 22, wherein the desired instantaneous value 
determining means determines a floor reaction force moment 
corresponding to the restricted restriction object amount as an 
instantaneous value of a floor reaction force moment of a desired 
floor reaction force constituting the desired gait. 

[Claim 24] 

The gait generation device of a legged mobile robot according 



zo clciim 18, wherein 

t/ie desired instantaneous value determining means comprises 
means for additionally inputting a correction amount of the 
desired motion to the dynamic model; and 

tJie means for determining the perturbation model manipulated 
varial^le comprises means for determining an estimated value of 
the iriS tan taneous value of the model restriction object amount 
output by the dynamic model on the basis of at least the 
instantaneous value of the model restriction object amount 
determined by the model calculating means in a case where the 
perturbation model manipulated variable is assumed to be zero, 
and means for comparing the estimated value of the model 
restr:_ction object amount with the permissible range to 
determine, on the basis of the comparison, a restricted 
restriLCtion object amount that has been restricted to fall within 
the permissible range, and determines the perturbation model 
manipulated variable on the basis of at least a difference between 
the determined instantaneous value of the model restriction 
objec": amcamt determined by the model calculating means and the 
restr.Lcted restriction object amount. 

[Claim 25] 

Tae gait generation device of a legged mobile robot according 
to claim 20 or 21, wherein 

tne desired instantaneous value determining means comprises 
means for additionally inputting a correction amount of the 
desired motion to the dynamic model; and 

tne means for determining the perturbation model manipulated 
variable comprises means for determining an estimated value of 
the instantaneous value of the model restriction object amount 
on the basis of at least the instantaneous value of the model 
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restr:..c tiori object amourit determined by the model calculating 
means and the require^d value in a case where the perturbation 
model manipulated variable is assumed to agree with the required 
value, and means for comparing the estimated value of the 
instantaneous value of the model restriction object amount with 
the permissible range to determine, on the basis of the comparison, 
a restricted restriction object amount that has been limited to 
the permissible range, and determines the perturbation model 
manipulated variable on the basis of at least a difference between 
the instantaneous value of the model restriction object amount 
determined by the model calculating means and the restricted 
restrr.ction object amount. 
[Claim 26] 

The gait generation device of a legged mobile robot according 
tio claim 24 or 25, wherein the desired instantaneous value 
determining means determines a floor reaction force moment 
corresponding to the restricted restriction object amount as an 
instantaneous value of a floor reaction force moment of a desired 
floor reaction force constituting the desired gait. 
[Claim 27] 

Tiie gait generation device of a legged mobile robot according 
'::o any one of claims 18 to 2 6, wherein the perturbation model 
is a model that represents a relationship between a perturbative 
motion perturbing a vertical component or a component in floor 
surfac:e normal line direction of an angular momentum changing 
rate of a robot and ai perturbation portion of the restriction 
object: amount. 

[Claim 28] 

The gait generation device of a legged mobile robot according 
to claim 27, wherein the perturbative motion is a perturbative 



motion maintaining the position of a center-o f -gravi ty of the 
robot substantially constant. 
[Claim 29] 

The gait generation device of a legged mobile robot according 
5 to claim 27 or 28, wherein the perturbative motion is a 
pertuL'bat j-ve motion of a body of the robot and/or an arm extended 
from the body. 
[Claim 30] 

A gait generation device for generating a desired gait of 
10 a legged mobile robot that travels by moving a plurality of legs 
extended from its body, comprising: 

permissible range setting means for setting a permissible 
range of c'i restriction object amount, the restriction object 
amount being a vertical component of a floor reaction force moment 
15 or a component of the floor reaction force moment in floor surface 
normal:, line direction to be applied to the robot or a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robots- 
desired floor reaction force provisional instantaneous 
20 value determining means for sequentially determining a 
provisional instantaneous value of at least a desired floor 
reaction force out of a desired motion and the desired floor 
react:.on force constituting the desired gait; 

first model calculating means for inputting at least a 
25 provisional instantaneous value of the desired floor reaction 
force to a first dynamic model expressing a relationship between 
a motion of the robot and a floor reaction force so as to 
sequentially determine a provisional instantaneous value of a 
desir^id motion as an output of the first dynamic model; 
30 second model calculating means for inputting at least the 
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provi.sionai instantaneous value of the desired motion to a second 
dynami'.c model expressing a relationship between a motion of the 
robot and the restriction object amount so as to determine an 
instantaneous value of a model restriction object amount as an 
output: of the second dynamic model; and 

first model input correcting means for determining a floor 
react:.on force moment correction amount of a desired floor 
reaction force so as to hold at least the instantaneous value 
of the; model restriction object amount within the permissible 
range, and for additionally inputting the determined floor 
reaction force moment correction amount to the first dynamic 
model , 

wherein the desired instantaneous value of the desired 
motion is determined on the basis of at least the input of the 
second dynamic model. 

[Claim 31] 

The gait generation device of a legged mobile robot according 
to claim 30^ wherein the means for determining the desired 
instantaneous value determines a floor reaction force moment 
corresponding to an ins t amt aneous value of the model restriction 
object amount outputted from the second dynamic model as an 
instantaneous value of a floor reaction force moment of a desired 
floor reaction force constituting the desired gait. 
[Claim 32] 

The gait generation device of a legged mobile robot according 
ro claim 30 or 31, wherein the first model input correcting means 
(::ompr:.ses means for determining an estimated value of the 
instantaneous value of the model restriction object amount 
outputted from the second dynamic model on the basis of at least 
the instantaneous value of the model restriction object amount 
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determined by the second dynamic model in a case where at least 
a floor reaction force moment correction amount of the desired 
floor reaction force is assumed to be zero, and means for 
comparing the estimated value of the instantaneous value of the 
model restriction object amount with the permissible range to 
deteriniine, on the basis of the comparison, a restricted 
restr:i. ction object amount that has been limited to the 
permissible range, and determines the floor reaction force 
moment correction amount on the basis of at least a difference 
between the instantaneous value of the model restriction object 
amount and the restricted restriction object amount. 
[Claim 33] 

Tae gait generation device of a legged mobile robot according 
to clc:iim 30 or 31, further comprising: 

means for determining a required value of a floor reaction 
force moment correction amount of the desired floor reaction 
force , 

wherein the first model input correcting means comprises 
means for determining, on the basis of at least the instantaneous 
value of the model restriction object amount determined by the 
second model calculating means and the required value, an 
estimated value of the instantaneous value of the model 
restriction object amount outputted from the second dynamic 
model when at least the floor reaction force moment correction 
amount of the desired floor reaction force is assumed to agree 
with :he required value, and means for comparing the estimated 
value of the instantaneous value of the model restriction object 
amount with the permissible range, and then determining a 
restricted restriction object amount limited to the permissible 
range on the basis of the comparison, and determines the floor 



reaction force moment correction amount on the basis of at least 
a difference between the instantaneous value of the model 
restriction object amount and the restricted restriction object 
amount. . 

[Claim 34] 

Tlie gait generation device of a legged mobile robot according 
to any one of claims 30 to 33, further comprising second model 
input correcting means for determining a correction amount of 
the desired motion on the basis of at least the instantaneous 
value of the model restriction object amount determined by the 
second model calculating means and the permissible range, and 
Chen additionally inputting the determined correction amount to 
the second dynamic model. 
[Claim 35] 

Tie gait generation device of a legged mobile robot according 
to claim 34, further comprising: 

a perturbation model that represents a relationship between 
a perturbative motion of the robot and a perturbation portion 
of a restriction object amounts- 
means for determining a manipulated variable of a floor 
reaction force moment on the basis of az least the instantaneous 
value of the model restriction object amount determined by the 
second model calculating means and the permissible range; and 
distributing means for dividing the determined manipulated 
variaole of the floor reaction force moment into a floor reaction 
force moment correction amount of the desired floor reaction 
force to be supplied to the first dynamic model and a perturbation 
model manipulated variable to be supplied to the perturbation 
model , 

wherein the second model input correcting means determines 



a correction amount of the desired motion by supplying the 
perturbation model manipulated variable to the perturbation 
model . 

[Claim 3 6] 

Tn65 gait generation device of a legged mobile robot according 
to claim 35, further comprising: 

means for determining a required value of a manipulated 
variable of the floor reaction force moment on the basis of at 
least a state amount of the perturbation model, 

waerein the means for determining a manipulated variable of 
the floor reaction force moment determines a manipulated 
variable of the floor reaction force moment to be supplied to 
the distributing means on the basis of at least the instantaneous 
value of the model restriction object amount determined by the 
second model calculating means, the permissible range, and the 
required value. 

[31aim 37] 

Tne gait generation device of a legged mobile robot according 
to claim 36, wherein the means for determining a required value 
of a manipulated variable of the floor reaction force moment 
sequentially determines the required value according to a 
feedback control law on the basis of a difference between a state 
amount of the perturbation model and a desired value relative 
to the state amount. 
[::iaim 38] 

The gait generation device of a legged mobile robot according 
to any one of claims 35 to 37, wherein the perturbation model 
is a model that represents a relationship between a perturbative 
motion perturbing a component of an angular momentum changing 
rate of a robot about a vertical axis or about a floor surface 
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norma., line axis and a perturbation portion of the restriction 
object: amount. 
[Claim 39] 

The gait generation device of a legged mobile robot according 
to clc.im 38, wherein the perturbative motion is a perturbative 
motion majntaining the position of a center-of -gravity of the 

robot substantially constant. 
[Claim 40] 

The gait generation device of a legged mobile robot according 
to claim 38 or 39, wherein the perturbative motion is a 
perturbative motion of a body of the robot and/or an arm extended 
from the body. 

[Claim 41] 

The gait generation device of a legged mobile robot according 
to claim 35, wherein the means for determining a manipulated 
variable of the floor reaction force moment comprises means for 
deteri:iining an estimated value of the instantaneous value of the 
model restriction object amount outputted from the second 
dynamic model on the basis of at least the instantaneous value 
of the model restriction object amount determined by the second 
model calculating means in a case where the perturbation model 
manipulated variable is assumed to be zero, and means for 
comparing the determined estimated value of the instantaneous 
value of the model restriction object amount with the permissible 
range to determine, on the basis of the comparison, a restricted 
restr:_ction object amount limited to the permissible range, and 
determines the manipulated variable of the floor reaction force 
moment on the basis of at least a difference between the 
instantaneous value of the model restriction object amount 
determined by the second model calculating means and the 
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restricted restriction object amount. 
[i:iaim 42] 

Tae gait generation device of a legged mobile robot according 
to claim 36, wherein the means for determining the manipulated 
variable of the floor reaction force moment comprises means for 
deterraining an estimated value of the instantaneous value of the 
model restriction object amount outputted from the second 
dynam.Lc model on the basis of at least the instantaneous value 
of the model restriction object amount determined by the second 
model calculating means and the required value in a case where 
the perturbation model manipulated variable is assumed to agree 
with the required value, and means for comparing the determined 
estim<ated value of the instantaneous value of the model 
restriction object amount with the permissible range to 
determine, on the basis of the comparison, a restricted 
restriction object amtount limited to the permissible range, and 
determines the manipulated variable of the floor reaction force 
momenz on the basis of at least a difference between the 
ins taiitaneous value of the model restriction object amount 
determined by the second model calculating means and the 
restricted restriction object amount. 
[Claim 43] 

A gait generation device for generating a desired gait of 
a legged mobile robot that travels by moving a plurality of legs 
extended from its body, comprising: 

permissible range setting means for setting a permissible 
range of a restriction object amount, the restriction object 
amounc being a vertical component of a floor reaction force moment 
or a c<3mponent of the floor reaction force moment in floor surface 
normai line direction to be applied to the robot or a vertical 
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component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot; 

desired floor reaction force provisional instantaneous 
value determining means for sequentially determining a 
provisional instantaneous value of at least a desired floor 
reaction force out of a desired motion and the desired floor 
reaction force constituting the desired gait; 

first model calculating means for inputting at least a 
provisional instantaneous value of the desired floor reaction 
force to a first dynamic model expressing a relationship between 
a motion of the robot and a floor reaction force so as to 
sequentially determine a provisional instantaneous value of a 
desired motion as an output of the first dynamic model; 

second model calculating means for inputting at least the 
provisional instantaneous value of the desired motion to a second 
dynamic model expressing a relationship between a motion of the 
robot and the restriction object amount so as to determine an 
instantaneous value of a model restriction object amount as an 
output of the second dynamic model; 

manipulated variable calculating means for determining a 
manipulated variable of a floor reaction force moment on the basis 
of at least a difference between a first provisional 
instantaneous value and a second provisional instantaneous value 
of the desired motion such that the difference approaches to zero; 
and 

model input correcting means for additionally inputting the 
manipulated variable of the floor reaction force moment to at 
least one of the first dynamic model and the second dynamic model, 

wherein the second provisional instantaneous value of the 
desired motion is determined as a desired instantaneous value 
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of the desired motion. 
f^Jiaim 44] 

T le gait generation device of a legged mobile robot according 
to claim 43, wherein the difference between the first provisional 
5 instantaneous value and the second provisional instantaneous 

value of the desired motion includes a difference in a state 
amoum. of a posture of a predetermined part of the robot about 
a vertical axis or a floor surface normal line axis. 
[Claim 45] 

10 Tne gait generation device of a legged mobile robot according 

to claim 33, further comprising a third model calculating means 
for inputting at least a provisional instantaneous value of the 
desir(5d floor reaction force to a third dynamic model 
representing a relationship between a motion of the robot and 

15 a floor reaction force so as to determine a third provisional 
instantaneous value of a desired motion as an output of the third 
dynam:_c model, wherein the means for determining a required value 
of a floor reaction force correction amount of the desired floor 
react:_on force determines the required value on the basis of a 

20 diffeirence between the determined desired instantaneous value 
of thei desired motion and the third provisional instantaneous 
value of the desi red mot ion such that the difference approximates 
t: o z e j: o . 

[Claim 46] 

25 The gait generation device of a legged mobile robot according 

CO any one of claims 16 to 45 further comprises slippage 
determining means for determining the occurrence of a slippage 
of the robot, wherein the permissible range setting means 
variably sets the permissible range according to a determination 

30 result of the slippage determining means. 
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[Claim 47] 

A gait: generation device for generating a desired gait of 
a legged mobile robot that travels by moving a plurality of legs 
extencied from its body, comprising: 

slippage determining means for determining the occurrence 
of a slippage of the robot; 

p(^rmissible range setting means for variably setting a 
permissible range of a lateral component of a trans lational floor 
react:.on force applied to the robot or a floor parallel component 
of the translational floor reaction force or a lateral component 
of acc:eleration of the overall center of gravity of the robot 
or a floor parallel component of acceleration of the overall 
centei: of gravity according to a determination result of the 
slippiige determining means; 

provisional motion determining means for determining a 
provisional motion in which a resultant force of the gravity force 
and the inertia force applied to the robot satisfy a predefined 
dynam:_c equilibrium condition as a provisional desired motion 
of the desired gait; and 

provisional motion correcting means for correcting the 
provisional motion and determining a motion of the desired gait 
by varying an angular momentum changing rate of the robot about 
the center of gravity in the provisional motion so as to satisfy 
uhe dynamic equilibrium condition, while restricting a lateral 
component of a translational floor reaction force applied to the 
robot which is defined according to the provisional motion of 
the desired gait or a floor parallel component of the 
translational floor reaction force or a lateral component of 
accelerati.on of the overall center of gravity of the robot or 
a floor parallel component of acceleration of the overall center 
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of gr^ivity to the permissible range if the lateral component of 
the t rans lational floor reaction force or the floor parallel 
component of the trans lational floor reaction force or the 
lateral component of acceleration of the overall center of 
gravicy of the robot or a floor parallel component of acceleration 
of the overall center of gravity has deviated from the permissible 
range . 

[Claim 48] 

A gait generation device for generating a desired gait of 
a legged mobile robot that travels by moving a plurality of legs 
extended from its body, comprising: 

slippage determining means for determining the occurrence 

of a olippage of the robots- 
permissible range setting means for variably setting a 
permissible range of a restriction object amount according to 
a determination result of the slippage determining means, the 
restriction object amount being a vertical component of a floor 
reaction force moment or a component of the floor reaction force 
moment in floor surface normal line direction to be applied to 
the robot or a vertical component or a component in floor surface 
normal line direction of an angular momentum changing rate of 
the robot; 

provisional motion determining means for determining a 
provisional motion as a provisional desired motion of the desired 
gait; and 

provisional motion correcting means for correcting the 
provisional motion and determining a motion of the desired gait 
by varying an angular momentum changing rate of the robot about 
the center of gravity in the provisional motion while restricting 
restri^ction object amount which is defined according to the 
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provisional motion of the desired gait to the permissible range 
if the restriction object amount has deviated from the 
permissible range. 
[Claim 49] 

A control device of a legged mobile robot adapted to 
sequentially determine instantaneous values of a desired motion 
and a desired floor reaction force of a legged mobile robot that 
travels by moving legs extended from its body by using a dynamic 
model that expresses a relationship between at least a motion 
of the^ robot and a floor reaction force^ and also to control an 
operation of the robot at the same time so as to make the robot 
follow the determined instantaneous values of the desired motion 
and tlie desired floor reaction force, comprising: 

slippage determining means for determining the occurrence 
of a slippage of the robots- 
permissible range setting means for variably setting a 
permissible range of a restriction object amount according to 
a determination result of the slippage determining means, the 
restriction object amount being a lateral component of a 
transnational floor reaction force applied to the robot or a floor 
parallel component of the tr ans lat i onal floor reaction force or 
a lateral component of acceleration of the overall center of 
gravity of the robot or a floor parallel component of acceleration 
of the overall center of gravity; and 

desired instantaneous value determining means for 
determining a new instantaneous value of the desired motion on 
the basis of a deviation between at least a desired state amount 
of a posture of the robot corresponding to the determined 
instantaneous value of the desired motion and an actual state 
amount of the robot so that the restriction object amount 
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de ter.Tiined according to the new instantaneous value and the 
dynamic model is restricted to the permissible range. 

[DETAILED DESCRIPTION OF THE INVENTION] 
5 [0001] 

[Technical Field to Which the Invention Belongs] 

The present invention relates to a control device suited to 
walking and also running of a legged mobile robot. 
[0002] 
10 [Prior Art] 

Hitherto, a major object of generating gaits (desired gaits) 
for making a legged mobile robot, e.g., a bipedal mobile robot, 
carry out a traveling motion has been focused mainly on generating 
gaits (walking gaits) to make the robot carry out a smooth walking 
15 motion. In recent years, however, as the development of legged 
mobile robots advances, it has come to be desired to generate 
gaits that enable the robots not only to walk but to run also. 
Furthermore, it has come to be desired to generate gaits that 
enable the robots to move without trouble even on a slippery floor 
20 (so-called low-p path) on which a sufficient frictional force 
cannot be produced. 
[0003] 

Since the Chinese characters for "'gait'' include a character 
meaning ''walking, " the gait tends to be misinterpreted that the 
25 definition thereof is limited to walking. However, "'gait" 

originally presents a concept that includes running, as it is 
used as a term indicating a running mode of a horse, such as 
''trot . 

[0004] 

30 The description will now be given of the difference in 
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characteristics between walking and running. 

A traveling mode that has an instant at which all legs are 
simultaneously floating is usually defined as running. This 
definition, however, does not necessarily make it possible to 
clearly distinguish between walking and running. For instance, 
most lumans have instants at which all legs float at the same 
time in f^ist jogging, whereas many humans have one of the legs 
always in contact with the ground in slow jogging. It is somehow 
perceptually unreasonable to define fast jogging as running and 
slow jogging as walking. 

[0005] 

Fig. 37 shows a pattern of a vertical body position and a 
floor reaction force vertical component (a sum of floor reaction 
force vertical components acting on right and left legs) in 
typical running, and Fig. 38 shows a pattern of a vertical body 
position and a floor reaction force vertical component in typical 
wal king . 

[30061 

A vertical body position/velocity means a vertical position 
of a I epresentative point of a body and a velocity thereof. A 
horizontal body position/velocity means a horizontal position 
of a 1 epresentative point of the body and a velocity thereof. 
A vertical body position/velocity and a horizontal body 
posit j.on/velocity together will be referred to as body 
position/velocity . 

[0007] 

St:rictly speaking, the ''floor reaction force vertical 
component" should be described as '' translational floor reaction 
force vertical component'' to distinguish it from a moment 
component about a vertical axis of a floor reaction force; however, 
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the term ls too long, so that the term " trans lational will be 
omitted. Hereinafter, the translational floor reaction force 
horizontal component^' will be described as ""floor reaction force 
horizontal component, " omitting " translational . " 
5 [0008] 

First, attention will be focused on the movement of the body. 
In walking, the body reaches a highest level at the instant the 
body passes over a supporting leg, while it reaches a lowest level 
at this instant in running. In other words, the phase of a 
10 vertical motion pattern of the body reverses between walking and 
runni ng . 

[0009] 

Meanwhile, a floor reaction force remains relatively 
constant in walking, whereas it considerably varies in running, 
15 the fioor reaction force reaching its maximum at the moment the 
body passes over a supporting leg. Needless to say, the floor 
reaction force is zero at the instant when all legs are 
simultaneously floating. More detailed observation reveals 
that ei floor reaction force of a magnitude that is substantially 
20 proportional to a compression amount of the supporting leg is 
gener<ated while running. In other words, it may be said that 
the legs are used like springs to jump for traveling while 
running . 

[0010] 

25 Slow jogging has the same body vertical motion phase as that 

of typical running. In addition, slow jogging frequently has 
no instants at which all legs are simultaneously floating; 
howev65r, even in this case, a floor reaction force reaches 
subs tc'in tial ly zero, although not completely zero, at an instant 

30 when a supporting leg and an idle leg are switched. 
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[0011] 

Hence, distinguishing between walking and running on the 
basis of the aforesaid characteristics of the vertical motions 
of the body or floor reaction force patterns as described above 
may be more appropriate and perceptually reasonable, because 
slow jogging is regarded also as running. 

[0012] 

In particular, to distinguish between the two on the basis 
of a Tiost characteristic aspect, running may be defined as a 
traveling mode in which the floor reaction force becomes zero 
or substantially zero at the instant a supporting leg is switched, 
while walking may be defined as a traveling mode (a floor reaction 
force vertical component remaining relatively constant) other 
than that , 

[0013] 

ThQ present applicant has previously proposed, in Japanese 
Patent Application No. 2000-352011, an art for generating freely 
and in real time a gait of a legged mobile robot that includes 
a flo(3r redaction force while substantially satisfying dynamic 
balance conditions (This means the conditions of balance among 
gravity, an inertial force, and a floor reaction force of a 
desired gait. In a narrow sense, it means that the horizontal 
component of a moment about a desired ZMP by the resultant force 
of gravity and an inertial force produced by a motion of a desired 
gait is zero. Detailed description will be given hereinafter) . 
This art and a series of the control devices of legged mobile 
robots proposed by the present applicant in, for example, 
Japanese Unexamined Patent Application Publication No. 10-86081 
and Japanese Unexamined Patent Application Publication No. 
10-277969 can be applied to walking and also to running. 
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[0014] 

These arts, however, have not considered the magnitude of 
a floor reaction force moment vertical component about ZMP of 
a desired gait. Hence, there has been a danger in that the floor 
5 reaction force moment vertical component unduly increases and 

exceeds a frictional limit, leading to a spin. The term "spin" 
refers to a state in which a yaw angular (a rotational angle about 
a vertical axis) velocity of an actual robot deviates from a 
desired yaw angular velocity. 
10 [0015] 

Wnen ex robot walks on a floor surface having a high friction 
coefficient (in this case, at least one^ leg is always in contact 
with the ground), a floor reaction force vertical component is 
always substantially equivalent to a robot' s own weight, thus 
15 provitiing a higher limit of a frictional force (i.e., the floor 
reaction force moment vertical component). This makes it 
difficult for a spin to occur. 
[0016] 

Ii running, however, the floor reaction force vertical 
20 component becomes zero or substantially zero, and in this case, 
therefore, the limit of a moment vertical component of the 
frictional force of a floor surface becomes zero or substantially 
zero €even if a friction coefficient is high. Hence, there has 
been a danger in that the floor reaction force moment vertical 
25 component of a desired gait exceeds a limit, resulting in a spin 
and a fall . 
[ D 0 1 7 ] 

Further, in the case of walking also, there has been a danger 
of spinning and falling if a floor has a low friction coefficient. 
30 [0018] 
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Msanwnile, the present applicant has previously proposed an 
arrangement, in which an arm is swung so as to cancel a moment 
vertical component generated by anything other than arms in a 
desired gait, in an embodiment described in, for example, PCT 
application PCT / JP02 / 1 3 5 9 6 . 
[0019] 

1 '1 this case, the moment vertical component of a desired gait 
is substantially zero. However, if legs are briskly swung to 
move, then the arms will be also briskly swung. 

[0020] 

Generally, the mass of an arm in a human-type robot is smaller 
than t,he mass of a leg. Accordingly, it is necessary to swing 

arms more briskly than legs in order to fully cancel a moment 
verti(ral component. 
[ 0 0 2 1 ] 

However, there is a restriction in the range of arm motion, 
and there are also restrictions in torque and velocity of arm 
actuators. Hence, there have been some cases where a moment 

vertical component cannot be fully canceled by arms when a robot 
moves while briskly swinging its legs - 
[0022 I 

Furthermore, there has been a danger in that, if arms are 
swung to cancel out a moment vertical component produced by 
anything other than arms in a desired gait, then the center of 
arm swing is gradually offset, causing the swings of the right 
^and left arms to be asymmetrical. Specifically, to make a left 
turn, if a robot swings its arms to fully offset a moment vertical 
component generated by anything other than arms, then the left 
arm is swung more toward the front and swung less toward the rear, 
while the right arm is swung less toward the front and swung more 



toward the rear in orde^r to offset the change in an angular 
mo.men-um c:aused by the legs and the body having turned to the 
left. This may cause the left arm to reach a motion limit of 
the sv/ing toward the front, and the right arm to reach a motion 
5 limit of the swing toward the rear. 
[0023 J 

Furthermore, if a motion is made to correct the center of 
the arm swinging so as to prevent the swings of the right and 
left arms from becoming asymmetrical, then a floor reaction force 
10 momen^L vertical component is generated. This in turn causes a 
floor reaction force moment vertical component of a desired gait 
to ex(::eed a limit, possibly causing the robot to spin. 
[0024 ] 

[Patent Document 1] Japanese Unexamined Patent Application 
15 Publication No. 10-86081 

[Patent Document 1] Japanese Unexamined Patent Application 
Publication No. 10-277969 
[0025] 

[Problem t:o Be Solved by the Invention] 

20 Accordingly, an object of the present invention is to provide 

a control device which solves the problems described above and 
which is capable of generating a further ideal gait regardless 
of gait types, such as walking and running, and a friction 
condit:ion of a floor surface. 

25 [0026] 

More specifically, an object of the present invention is to 
provide a control device capable of operating a robot by gaits 
that enable the robot to prevent spinning or falling from a spin, 
while maintaining a stable posture state in a yaw direction of 
30 the robot by considering a limit of a moment vertical component 
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of a frictional force between the robot and a floor surface. 
Another object is to provide a control device capable of operating 
a robot by a gait motion pattern that satisfies a dynamic balance 
condition even in a leg-floating period or even if the limit of 
a moment vertical component of a frictional force is extremely 
low. Still another object is to prevent lateral asymmetry of 
a desLx^ed gait from increasing so as to secure continuity of a 
motion . 

[0027] 

[Means for Solving the Problem] 

To attain an object of the present invention, according to 
a first aspect of a control device of a legged mobile robot in 
accordance with the present invention, there is provided a 
control device of a legged mobile robot adapted to sequentially 
determine instantaneous values of a desired motion and a desired 
floor reaction force of a legged mobile robot that travels by 
moving legs extended from its body by using a dynamic model that 
expresses a relationship between at least a motion of the robot 
and a floor reaction force, and also to control an operation of 
the robot at the same time so as to make the robot follow the 
determined instantaneous values of the desired motion and the 
desired floor reaction force, comprising: 

permissible range setting means for setting a permissible 
range of a restriction object amount, the restriction object 
amount being a vertical component of a floor reaction force moment 
or a component of the floor reaction force moment in floor surface 
normal line direction to be applied to the robot or a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot; and 

desired instantaneous value determining means for 
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de tern:ii ni ng , on the basis of at least a difference between a 
desired scate amount related to a posr.ure of the robot about a 
vertical axis or about a floor surface normal line axis and an 
actual state amount of the robot and the permissible range, 
instantaneous values of the desired motion and the desired floor 
reaction force such that a deviation between a floor reaction 
force moment balancing with the desired motion on the dynamic 
model and a floor reaction force moment of the desired floor 
reaction force approximates the difference to zero, while having 
the restriction object amount, which is associated with the 
desired floor reaction force, fall within the permissible range 
(Claim 1) . 
[ 0028 ] 

According to the first aspect of the present invention, on 
the basis of at least a difference between a desired state amount 
related to a posture of the robot about a vertical axis or about 
a floc^r surface normal line axis and an actual state amount of 
the rcibot and the permissible range, instantaneous values of the 
desired motion and the desired floor reaction force are 
determined such that the deviation between a floor reaction force 
momen ~ balancing with the desired motion on the dynamic model 
and a floor reaction force moment of the desired floor reaction 
force approximates the above difference to zero, while setting 
a restriction object amount, which is associated with the desired 
floor reaction force, to fall within the permissible range. 
Therefore, a restriction object amount, such as a floor reaction 
force moment vertical component applied to an actual robot, can 
be set to fall within a permissible range, while maintaining 
stable the posture of the robot. Accordingly, it is possible 
CO prevent the robot from spinning and falling caused by a spin, 
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cons id€5 r ing a limit of a frictional force moment vertical 
compo -lent . 
[0029] 

Preferably, in the control device of the first invention. 
The control device of a legged mobile robot according to claim 
1, wherein the desired instantaneous value determining means 
comprLses means for determining a reference instantaneous value 
of the des i red motion, means for determining a compensating floor 
reaction force moment, which is an additional floor reaction 
force moment for approximating the difference to zero on the basis 
of the; difference, means for determining a provisional value of 
the restriction object amount which is associated with a 
provisional instantaneous value of the desired floor reaction 
force on the basis of at least a floor reaction force moment that 
balan<res with the reference instantaneous value on the dynamic 
model and the compensating floor reaction force moment, means 
for defining a floor reaction force moment corresponding to a 
restricted restriction object amount obtained by limiting the 
provisional value of the restriction object amount to the 
permissible range as an floor reaction force moment 
instantaneous value of the desired floor reaction force, and 
means for determining a. correction amount of the reference 
instantaneous value on the basis of the determined floor reaction 
force moment instantaneous value, the floor reaction force 
moment, that balances with the reference instantaneous value on 
the dynamic model and the compensating floor reaction force 
moment:, and determining the instantaneous value of the desired 
motion by correcting the reference instantaneous value with the 
determined correction amount (Claim 2). 

[0030] 
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Preferably, the means for determining the provisional value 
of the? restriction object amount comprises means for determining 
a model correction floor reaction force moment, which is an 
additional floor reaction force moment for approximating a state 
amount of the dynamic model to a predetermined state amount, and 
determines the provisional value of the restriction object 
amount on the basis of at least the floor reaction force moment 
that balances with the reference instantaneous value on the 
dynamic model and the compensating floor reaction force moment, 
the compensating floor reaction force moment, and the model 
correction floor reaction force moment (Claim 3). 

[ 3031 I 

Farther, the correction amount of the reference 
instantaneous value is a correction amount of a motion that 
changes a vertical component or a component in floor surface 
normal line direction of the angular momentum changing rate of 
the robot (Claim 4) . Furthermore, the motion that changes the 
vertical component or the component in floor surface normal line 
direc"':ion of the angular momentum changing rate of the robot is 
a motj on of a body of the robot and/or an arm extended from the 
body of the robot (Claim 5) . 

[0 032] 

According to a second aspect of a control device of a legged 
mobile robot of the present invention, there is provided a control 
device of a legged mobile robot adapted to sequentially determine 

an in^; tantaneous value of a desired motion of a legged mobile 
robot that travels by moving legs extended from its body by using 
a dynamic model that expresses a relationship between at least 
a motion of the robot and a floor reaction force, and also to 
control an operation of the robot at the same time so as to make 
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the robot follow the determined instantaneous value of the 
desired motion, comprising: 

permissible range setting means for setting a permissible 
range of a restriction object amount, the restriction object 
amount being a vertical component of a floor reaction force moment 
or a component of the floor reaction force moment in floor surface 
normal line direction to be applied to the robot or a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot; 

compensating floor ireaction force moment determining means 
for determining a compensating floor reaction force moment, 
which is an additional floor reaction force moment for bringing 
a difference between a desired state amount related to a posture 
of the robot about a vertical axis or a floor surface normal line 
axis and an actual state amount of the robot close to zero on 
the basis of at least the difference; and 

desired instantaneous value determining means for 
determining an instantaneous value of the desired motion such 
that the restriction object amount corresponding to the sum of 
a floor reaction force moment balancing with the desired motion 
on th€; dynamic model and the compensating floor reaction force 
moment falls within the permissible range (Claim 6) . 

[0033 J 

According to the sixth invention, an instantaneous value of 
the desired motion is determined such that the restriction object 
amount: corresponding to the sum of a floor reaction force moment 
balancing with the desired motion on the dynamic model and the 
compensating floor reaction force moment falls within the 
permissible range. Therefore, by maintaining the restriction 
object amount in the permissible range on consideration of a limit 
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of a frictional force moment vertical component, it is possible 
to prevent the robot from spinning and falling caused by a spin. 
[00341 

I- is preferable that the second aspect of the present 
inven";:ion further comprises means that defines the sum of the 
floor reaction force moment balancing with the desired motion 
on the; dynamic model and the compensating floor reaction force 
moment as a desired floor reaction force moment, and controls 
the operation of the robot so as to make the robot follow the 
desired floor reaction force moment (Claim 7). 

[0035] 

It is preferable that the desired instantaneous value 
determining means determines an instantaneous value of the 
desired motion by adjusting a motion that changes a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot among motions 
of the robot in order to hold the restriction object amount 
corresponding to the sum of the floor reaction force moment 
balancing with the desired motion on the dynamic model and the 
compensating floor reaction force moment, within the permissible 
range (Claim 8) . 

[0036 J 

It is preferable that the motion that changes a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot is a motion 
of a body of the robot and/or an arm extended from the body (Claim 
9) . 

[ 0 0 3 7 J 

According to a third aspect of a legged mobile robot of the 
present invention, there is provided a control device of a legged 
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mobile robot adapted to sequentially determine an instantaneous 
value of a desired motion of a legged mobile robot that travels 
by moving legs extended from its body by using a dynamic model 
expressing at least a relationship between a motion of the robot 
and a floor reaction force, and also to control an operation of 
the robot at the same time so as to make the robot follow the 
determined instantaneous value of the desired motion, 
c omp rising: 

permissible range setting means for setting a permissible 
range of a restriction object amount, the restriction object 
amount being a vertical component of a floor reaction force moment 
or a component of the floor reaction force moment in floor surface 
normal line direction to be applied to the robot or a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot; 

reference instantaneous value determining means for 
sequentially determining a reference instantaneous value of the 
desired motion; 

compensating floor reaction force moment determining means 
for determining a compensating floor reaction force moment, 
which is an additional floor reaction force moment for bringing 
a dif jJerence between a desired state amount related to a posture 
of the robot about a vertical axis or a floor surface normal line 
axis and an actual state amount of the robot close to zero on 
the basis of at least the difference; and 

desired instantaneous value determining means for defining 
a port, ion of the sum of the floor reaction force moment balancing 
with the reference instantaneous value of the desired motion on 
the dynamic model and the compensating floor reaction force 
moment, which deviates from the permissible range, as a moment 
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correction manipulated variable, and determining an 
instantaneous value of the desired motion by correcting the 
reference instantaneous value of the desired motion with the 
momen : correction manipulated variable (Claim 10) . 
[ 3038 1 

According to the third aspect of the present invention, a 
porti'3n of the sum of the^ floor reaction force moment balancing 
with the reference instantaneous value of the desired motion on 
the dynamic model and the compensating floor reaction force 
momenc, which deviates from the permissible range, as a moment 
correction manipulated variable, and the instantaneous value of 
the desired motion is determined by correcting the reference 
instantaneous value of the desired motion with the moment 
correction manipulated variable. Thereby, by maintaining the 
restriction object amount in the permissible range on 
consideration of a limit of a frictional force moment vertical 
component, it is possible to prevent the robot from spinning and 
falling caused by a spin. 

i; 003 9.1 

i]i the third aspect of the present invention, it is 
preferable that the desired instantaneous value determining 
means determines an instantaneous value of the desired motion 
by determining a correction amount of the reference 
instantaneous value of the desired motion on the basis of a result 
obtained by passing the moment correction manipulated variable 
through a low-pass filter, and then by correcting the reference 
instantaneous value on the basis of the determined correction 
amount: (Claim 11) . 

[004 0] 

It is preferable that the present invention further 
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(3ompr.Lses means for defining, as a desired floor reaction force 
momem:, a floor reaction force moment obtained by limiting the 
sum of a floor reaction force moment balancing with the reference 
instantaneous value of the desired motion on the dynamic model 
5 and the compensating floor reaction force moment to the 
permissible range, and for controlling an operation of a robot 
so as to make the robot follow the desired floor reaction force 
moment (Claim 12) . 
[0041] 

10 Iz is preferable that the desired instantaneous value 

determining means determines an instantaneous value of the 
desire^d motion by correcting a motion for changing a vertical 

component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot on the basis 
15 of a reference instantaneous value of the desired motion (Claim 
13) . 

[00 42] 

I~ is preferable in the first to third aspect of the present 
invention that the state amount related to a posture of the robot 
20 inclucies ai yaw angle or a yaw angular velocity of the body of 
the robot (Claim 14). 

[00431 

It: is preferable that the present invention further 
comprises slippage determining means for determining occurrence 
25 of a slippage of the robot, wherein the permissible range setting 
means variably sets the permissible range according to a 

determination result of the slippage determining means (Claim 
15) . 

[0044] 

30 According to a first aspect of a gait generation device of 
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a legged mobile robot of the present invention, there is provided 
a gait generation device that generates a desired gait of a legged 
mobile robot that travels by moving a plurality of legs extended 
from its body, comprising: 

permissible range setting means for setting a permissible 
range of a restriction object amount, the restriction object 
amounc being a vertical component of a floor reaction force moment 
or a component of the floor reaction force moment in floor surface 
normal line direction to be applied to the robot or a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot; 

provisional instantaneous value determining means for 
determining a provisional instantaneous value of a desired 
motion constituting the desired gait; 

model calculating means that inputs at least a provisional 
instantaneous value of the desired motion to a dynamic model 
representing a relationship between a motion of the robot and 
the restriction object amount, and then determines an 
instantaneous value of a model restriction object amount as an 
output of the dynamic model; and 

desired instantaneous value determining means for 
determining an instantaneous value of the desired motion by 
correcting a provisional instantaneous value of the desired 
motion such that at least the instantaneous value of the model 
restriction object amount falls within the permissible range 
(Claim 16) . 
[0045] 

According to the first aspect of the gait generation device 
of the present invention, the instantaneous value of the desired 
motion is determined by correcting a provisional instantaneous 

-42 - 



value of the desired motion such that at least the instantaneous 
value of the model restriction object amount falls within the 
permissible range; thereby, the desired gait can be generated 
by maintaining the restriction object amount in the permissible 
range on consideration of a limit of a frictional force moment 
vertical component, and consequently, it is possible to prevent 
the rcDbot from spinning and falling caused by a spin. 
[00461 

In the first aspect of the gait generation device, it is 
preferable that the desired instantaneous value determining 
means determines a floor reaction force instantaneous value 

corresponding to a restriction object amount substantially 
balan(-ing with an instantaneous value of the desired motion on 
the dynamic model as an instantaneous value of a desired floor 
reaction force constituting the desired gait (Claim 17). 
[0047] 

It is preferable that the desired instantaneous value 
determining means comprises: 

a perturbation model representing a relationship between a 
perturbatLve motion of the robot and a perturbative portion of 
the restriction object amounts- 
means for determining a perturbation model manipulated 
variaole for manipulating the perturbative portion of the 
restriction object amount of the perturbation model on the basis 
of at least the instantaneous value of the model restriction 
object amount and the permissible range; 

means for determining a correction amount of the desired 
motion by supplying the determined perturbation model 
manipulated variable to the perturbation model; and 

means for determining an instantaneous value of the desired 
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motion by correcting a provisional instantaneous value of the 
desired motion by using the correction amount (Claim 18). 
[ 0048 J 

In this regarding, it is preferable that the means for 
determining the perturbation model manipulated variable 
compra.ses means for de tc^rmining , on the basis of at least the 
instantaneous value of the model restriction object amount 
determined by the model calculating means, an estimated value 
of the restriction object amount in a case where the perturbation 
model manipulated variable is assumed to be zero, and means for 
compairing the determined estimated value with the permissible 
range to determine, on the basis of the comparison, a restricted 
res tr::.c tion object amount that has been restricted to fall within 
the pc^rmissible range, and determines the perturbation model 
manipulated variable on the basis of at least a difference between 
the instantaneous value of the model restriction object amount 
determined by the model calculating means and the restricted 
restr:_ction object amount (Claim 19). 

[ (J 0 4 9 J 

I - is preferable that the gait generation device of a legged 
mobiles robot according to claim 18 further comprises: means for 
determining a required value of the perturbation model 
manipulated variable on the basis of at least a state amount of 
the perturbation model, wherein the means for determining the 
pertujrbat ion model manipulated variable determines a 
perturbation model manipulated variable to be supplied to the 
perturbation model on the basis of the instantaneous value of 
the model restriction object amount, the permissible range, and 
the r^^quired value (Claim 20) . 

[0050] 
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Ill this case, it is preferable that the means for determining 
a required value of the perturbation model manipulated variable 
sequentially determines the required value according to a 
feedback control law on the basis of a difference between a state 
amount, of the perturbation model and a desired value relative 
■::o the state amount (Claim 21) . 

[1)051] 

Ic is preferable that the means for determining the 
perturbation model manipulated variable comprises means for 
determining an estimated value of the restriction object amount 
in a case, where the perturbation model manipulated variable is 
assumed to agree with the required value, on the basis of at least 
the instantaneous value of the model restriction object amount 
determined by the model calculating means and the required value, 
and means for comparing the determined estimated value with the 
permissible range to determine, on the basis of the comparison, 
a rest.ricted restriction object amount that has been limited to 
the permissible range, and determines the perturbation model 
manipulated variable on the basis of at least a difference between 
the instantaneous value of the model restriction object amount 
determined by the model calculating means and the restricted 
restriction object amount (Claim 22) . 

[0052 1 

In claim 19 or 22, it is preferable that the desired 
instantaneous value determining means determines a floor 
reactLon force moment corresponding to the restricted 
restriction object amount as an instantaneous value of a floor 
reaction force moment of a desired floor reaction force 
constituting the desired gait (Claim 23). 

[0053 ) 
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In claim 18, it is preferable that the desired instantaneous 
value determining means comprises means for additionally 
inputt:ing a correction amount of the desired motion to the dynamic 
model; and the means for determining the perturbation model 
manipulated variable comprises means for determining an 
estimated value of the instantaneous value of the model 
restriction object amount output by the dynamic model on the basis 
of at least the instantaneous value of the model restriction 
object: amount determined by the model calculating means in a case 
where the perturbation model manipulated variable is assumed to 
be zero, and means for comparing the estimated value of the model 
restr.-.ction object amount with the permissible range to 
determine, on the basis of the comparison, a restricted 
restriLCtion object amount that has been restricted to fall within 
the permissible range, and determines the perturbation model 
manipulated variable on the basis of at least a difference between 
the determined instantaneous value of the model restriction 
object amount determined by the model calculating means and the 
restricted restriction object amount (Claim 24). 

[0054] 

In claim 20 or 21, it is preferable that the desired 
instantaneous value determining means comprises means for 
additionally inputting a correction amount of the desired motion 
to tt.e dynamic model; and the means for determining the 
perturbation model manipulated variable comprises means for 
determining an estimated value of the instantaneous value of the 
model restriction object amount on the basis of at least the 
instantaneous value of the model restriction object amount 
determined by the model calculating means and the required value 
in a case where the perturbation model manipulated variable is 
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assumed tc agree with the required value, and means for comparing 
the estimated value of the instantaneous value of the model 
restrrction object amount with the permissible range to 
determine, on the basis of the comparison, a restricted 
restriction object amount that has been limited to the 
permissible range, and determines the perturbation model 
manipulated variable on the basis of at least a difference between 
the instantaneous value of the model restriction object amount 
determined by the model calculating means and the restricted 
restriction object amount (Claim 25). 
[ D055 1 

In claim 24 or 25, it is preferable that the desired 
instantaneous value determining means determines a floor 
reaction force moment corresponding to the restricted 
restriction object amount as an instantaneous value of a floor 
reaction force moment of a desired floor reaction force 
constituting the desired gait (Claim 26). 

[3056] 

It is preferable that the perturbation model is a model that 
represents a relationship between a perturbative motion 
perturbing a vertical component or a component in floor surface 
normal line direction of an angular momentum changing rate of 
a robot and a perturbation portion of the restriction object 
amouni (Claim 27). 

It is preferable that the perturbative motion is a 
perturbative motion maintaining the position of a 
center-of -gravity of the robot substantially constant (Claim 
28) . 

It is further preferable that the perturbative motion is a 
perturbative motion of a body of the robot and/or an arm extended 

-47- 



from ':he body (Claim 29). 
[ 0057 i 

A::cording to a second aspect of a gait generation device of 
a legged mobile robot of the present invention, there is provided 
a gait generation device for generating a desired gait of a legged 
mobile robot that travels by moving a plurality of legs extended 
from -Lts body, comprising: 

permissible range setting means for setting a permissible 
range of a restriction object amount, the restriction object 
amount being a vertical component of a floor reaction force moment 
or a component of the floor reaction force moment in floor surface 
normal line direction to be applied to the robot or a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot; 

desired floor reaction force provisional instantaneous 
value determining means for sequentially determining a 
provisional instantaneous value of at least a desired floor 
reaction force out of a desired motion and the desired floor 
react.Lon force constituting the desired gait; 

first model calculating means for inputting at least a 
provisional instantaneous value of the desired floor reaction 
force to a first dynamic model expressing a relationship between 
a motion of the robot and a floor reaction force so as to 
sequentially determine a provisional instantaneous value of a 
desired motion as an output of the first dynamic model; 

second model calculating means for inputting at least the 
provision£il instantaneous value of the desired motion to a second 
dynam.LC model expressing a relationship between a motion of the 
robot and the restriction object amount so as to determine an 
instantaneous value of a model restriction object amount as an 
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outpu" of the second dynamic model; and 

first model input correcting means for determining a floor 
reaction force moment correction amount of a desired floor 
react-ion force so as to hold at least the instantaneous value 
of the model restriction object amount within the permissible 
range, and for additionally inputting the determined floor 
reaction force moment correction amount to the first dynamic 
model ; 

wnerein the desired instantaneous value of the desired 
motion is determined on the basis of at least the input of the 
second dynamic model (Claim 30) . 

[0058 1 

According to the second aspect of the gait generation device 
of the present invention, the desired gait can be generated by 
maintaining the restriction object amount in the permissible 
range on consideration of a limit of a frictional force moment 
vertical component; thereby, it is possible to prevent the robot 
from spinning and falling caused by a spin. 

[ i]05 9 I 

thes second aspect of the gait generation device of the 
present invention, it is preferable that the means for 
determining the desired instantaneous value determines a floor 
react:._on force moment corresponding to an instantaneous value 
of the model restriction object amount outputted from the second 
dynamj.c model as an instantaneous value of a floor reaction force 
moment:, of a\ desired floor reaction force constituting the desired 
gait XI aim 31). 
[0060] 

It: is preferable that the first model input correcting means 
comprises means for determining an estimated value of the 
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ins taiitaneous value of the model restriction object amount 
outpurted from the second dynamic model on the basis of at least 
the instantaneous value of the model restriction object amount 
determined by the second dynamic model in a case where at least 
a floor reaction force moment correction amount of the desired 
floor reaction force is assumed to be zero, and means for 
comparing the estimated value of the instantaneous value of the 
model restriction object amount with the permissible range to 
determine, on the basis of the comparison, a restricted 
restriction object amount that has been limited to the 
permissible range, and determines the floor reaction force 
momen" correction amount on the basis of at least a difference 
oetween the instantaneous value of the model restriction object 
amount and the restricted restriction object amount (Claim 32) . 
[ DO 61 I 

It is preferable that the gait generation device of present 
inven-^iion further comprises: means for determining a required 
value of a floor reaction force moment correction amount of the 
desired floor reaction force, wherein the first model input 
cor ret:: ting means comprises means for determining, on the basis 
of at least the instantaneous value of the model restriction 
objec^- amount determined by the second model calculating means 
and the required value, an estimated value of the instantaneous 
value of the model restriction object amount outputted from the 
second dynamic model when at least the floor reaction force moment 
correction amount of the desired floor reaction force is assumed 
to agjree with the required value, and means for comparing the 
estimated value of the instantaneous value of the model 
restr.LCtion object amount with the permissible range, and then 
determining a restricted restriction object amount limited to 
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the permissible range on the basis of the comparison, and 
determines the floor reaction force moment correction amount on 
the basis of at least a difference between the instantaneous value 
of the model restriction object amount and the restricted 
restriction object amount (Claim 33). 
[0062 ] 

It is preferable that the gait generation device of the 
present invention further comprises second model input 
correcting means for determining a correction amount of the 
desired motion on the basis of at least the instantaneous value 
of th€B model restriction object amount determined by the second 
model calculating means and the permissible range, and then 
additionally inputting the determined correction amount to the 
second dynamic model (Claim 34) . 

[0063] 

In this case, it is preferable that the gait generation 
device of the present invention further comprises: 

a perturbation model that represents a relationship between 
a perzurbative motion of the robot and a perturbation portion 
of a restriction object amounts- 
means for determining a manipulated variable of a floor 
reaction force moment on the basis of at least the instantaneous 
value of the model restriction object amount determined by the 
second model calculating means and the permissible range; and 
distributing means for dividing the determined manipulated 
variable of the floor reaction force moment into a floor reaction 
force momeant correction amount of the desired floor reaction 
force to be supplied to the first dynamic model and a perturbation 
model manipulated variable to be supplied to the perturbation 
model , 
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wtierein the second model input correcting means determines 
a correction amount of the desired motion by supplying the 
perturbation model manipulated variable to the perturbation 
model (Claim 35) . 

[0064 1 

Iz is preferable that the gait generation device of the 
present invention further comprises: 

means for determining a required value of a manipulated 
variable of the floor reaction force moment on the basis of at 
least a state amount of the perturbation model, 

wnerein the means for determining a manipulated variable of 
the floor reaction force moment determines a manipulated 
variable of the floor reaction force moment to be supplied to 
the distributing means on the basis of at least the instantaneous 
value of the model restriction object amount determined by the 
seconci model calculating means, the permissible range, and the 
required value (Claim 36) . 

[00 65] 

I': is preferable that the means for determining a required 
value of a manipulated variable of the floor reaction force moment 
sequentially determines the required value according to a 
feedback control law on the basis of a difference between a state 
amount of the perturbation model and a desired value relative 
to the state amount (Claim 37) . 

[00 66] 

is preferable that the perturbation model is a model that 
represents a relationship between a perturbative motion 
perturbing a component of an angular momentum changing rate of 
a robot about a vertical axis or about a floor surface normal 
line axis and a perturbation portion of the restriction object 

-52- 



amoun-: (Claim 38) . 
[00 67 1 

It is preferable that the perturbative motion is a 
oerturbative motion maintaining the position of a 
center-of -gravity of the robot substantially constant (Claim 
39) . 

[ DO 68 1 

It is preferable that the perturbative motion is a 
perturbative motion of a body of the robot and/or an arm extended 
from 3.he body (Claim 40) . 

[0069] 

It is preferable that the means for determining a manipulated 
variaiole of the floor reaction force moment comprises means for 
determining an estimated value of the instantaneous value of the 
model restriction object amount outputted from the second 
dynamic model on the basis of at least the instantaneous value 
of the model restriction object amount determined by the second 
model calculating means in a case where the perturbation model 
manipjlated variable is assumed to be zero, and means for 
comparing the determined estimated value of the instantaneous 
value of the model restriction object amount with the permissible 
range to determine, on the basis of the comparison, a restricted 
restriction object amount limited to the permissible range, and 
determines the manipulated variable of the floor reaction force 
moment on the basis of at least a difference between the 
instantaneous value of the model restriction object amount 
determined by the second model calculating means and the 
restricted restriction object amount (Claim 41). 

[0070] 

It is also preferable that the means for determining the 
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manipiilate-d variable of the floor reaction force moment 
compr.\-ses means for determining an estimated value of the 
Instantaneous value of the model restriction object amount 
outputted from the second dynamic model on the basis of at least 
the instantaneous value of the model restriction object amount 
determined by the second model calculating means and the required 
value in a case where the perturbation model manipulated variable 
is assumed to agree with the required value, and means for 
comparing the determined estimated value of the instantaneous 
value of the model restriction object amount with the permissible 
range to determine, on the basis of the comparison, a restricted 
restriction object amount limited to the permissible range, and 
determines the manipulated variable of the floor reaction force 
momen- on the basis of at least a difference between the 
instantaneous value of the model restriction object amount 
determined by the second model calculating means and the 
restricted restriction object amount (Claim 42). 
[00711 

According to a third aspect of a gait generation device of 
a legged mobile robot of the present invention, there is provided 
a gait generation device for generating a desired gait of a legged 
mobile robot that travels by moving a plurality of legs extended 
from its body, comprising: 

permissible range setting means for setting a permissible 
range of a restriction object amount, the restriction object 
amount being a vertical component of a floor reaction force moment 
or a component of the floor reaction force moment in floor surface 
normal line direction to be applied to the robot or a vertical 
component or a component in floor surface normal line direction 
of an angular momentum changing rate of the robot; 
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desired floor reaction force provisional instantaneous 
value determining means for sequentially determining a 
provisional instantaneous value of at least a desired floor 
react:-on force out of a desired motion and the desired floor 
reacti-on force constituting the desired gait; 

first model calculaiting means for inputting at least a 
provisional! instantaneous value of the desired floor reaction 
force to a first dynamic model expressing a relationship between 
a motion of the robot and a floor reaction force so as to 
sequentially determine a provisional instantaneous value of a 
desired motion as an output of the first dynamic models- 
second model calculating means for inputting at least the 
provision^il instantaneous value of the desired motion to a second 
dynam:_c model expressing a relationship between a motion of the 
robot and the restriction object amount so as to determine an 
instantaneous value of a model restriction object amount as an 
output: of the second dynamic model; 

manipulated variable calculating means for determining a 
manipulat€^d variable of a floor reaction force moment on the basis 
of ai: least a difference between a first provisional 
instantaneous value and a second provisional instantaneous value 
of the de s i red mot i on such that the difference approaches to zero; 
and 

model input correcting means for additionally inputting the 
manipulated variable of the floor reaction force moment to at 

least one of the first dynamic model and the second dynamic model, 
wherein the second provisional instantaneous value of the 

desir^id motion is determined as a desired instantaneous value 

of the desired motion (Claim 43). 
[ 0072 ] 
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According to the third aspect of the gait generation device 
of the. present invention, the desired gait can be generated by 
maintaining the restriction object amount in the permissible 
range on consideration of a limit of a frictional force moment 
vertical component according to the first and the second dynamic 
models; thereby, i t i s pos s ible to prevent the robot from spinning 
and frilling caused by a spin. 
[(3073] 

According to the third aspect of the gait generation device 
of the present invention, it is preferable that the difference 
between the first provisional instantaneous value and the second 
provisional instantaneous value of the desired motion includes 

a difference in a state amount of a posture of a predetermined 
part of the robot about a vertical axis or a floor surface normal 
line axis (Claim 44). 
[ 3074 ] 

It is preferable that the invention of claim 33 further 
comprises a third model calculating means for inputting at least 
a provisional instantaneous value of the desired floor reaction 
force to a third dynamic model representing a relationship 
between a motion of the robot and a floor reaction force so as 
to determine a third provisional instantaneous value of a desired 
motion as an output of the third dynamic model, wherein the means 
for determining a required value of a floor reaction force 
correction amount of the desired floor reaction force determines 
the required value on the basis of a difference between the 
determined desired instantaneous value of the desired motion and 
the tliird provisional instantaneous value of the desired motion 
such that the difference approximates to zero (Claim 45) . 

It is preferable that the gait generation device according 
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CO the first to the third aspect of the present invention further 
compr:.ses slippage determining means for determining the 
occurrence of a slippage of the robot, wherein the permissible 
range setting means variably sets the permissible range 
according to a determination result of the slippage determining 
means {Claim 46) . 
[0075] 

According to a fourth aspect of a gait generation device of 
a legged mobile robot of the present invention, there is provided 
a gait generation device for generating a desired gait of a legged 
mobile robot that travels by moving a plurality of legs extended 
from its body, comprising: 

slippage determining means for determining the occurrence 
of a slippage of the robots- 
permissible range setting means for variably setting a 
permissible range of a lateral component of a translational floor 
reaction force applied to the robot or a floor parallel component 
of the translational floor reaction force or a lateral component 
of acceleration of the overall center of gravity of the robot 
or a floor parallel component of acceleration of the overall 
center of gravity according to a determination result of the 
slippage determining means; 

provisional motion determining means for determining a 
provisional motion in which a resultant force of the gravity force 
and the inertia force applied to the robot satisfy a predefined 
dynamic equilibrium condition as a provisional desired motion 
of the desired gait; and 

provisional motion correcting means for correcting the 
provisional motion and determining a motion of the desired gait 
by varying an angular momentum changing rate of the robot about 
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-he center of gravity in the provisional motion so as to satisfy 
-he d:^namic equilibrium condition, while restricting a lateral 
component of a trans lational floor reaction force applied to the 
robot which is defined according to the provisional motion of 
5 the desired gait or a floor parallel component of the 
trans.^a tional floor reaction force or a lateral component of 
acceleration of the overall center of gravity of the robot or 
a floor parallel component of acceleration of the overall center 
of gravity to the permissible range if the lateral component of 

10 the translational floor reaction force or the floor parallel 
component of the trans lational floor reaction force or the 
lateral component of acceleration of the overall center of 
gravi'iy of the robot or a floor parallel component of acceleration 
of the overall center of gravity has deviated from the permissible 

15 range (Claim 47 ) . 
[3076] 

According to the fourth aspect of the gait generation device, 
the de'sired gait can be generated so that the restriction object 
amount related to the lateral component of the friction force 
20 will not surpass the permissible range in accordance with the 
determination result of the occurrence of the robot; thereby, 
it is possible to prevent the robot from spinning and falling 
caused by a spin. 
[0077] 

25 According to a fifth aspect of a gait generation device of 

a legcfed mobile robot of the present invention, there is provided 
a gait generation device for generating a desired gait of a legged 
mobile robot that travels by moving a plurality of legs extended 
from its body, comprising: 

30 slippage determining means for determining the occurrence 
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of a .slippage of the robot; 

permissible range setting means for variably setting a 
permissible range of a restriction object amount according to 
a determination result of the slippage determining means, the 
restr:..ction object amount being a vertical component of a floor 
react:.on force moment or a component of the floor reaction force 
momem: in floor surface normal line direction to be applied to 
the robot or a vertical component or a component in floor surface 
normal line direction of an angular momentum changing rate of 
the robot; 

provisional motion determining means for determining a 
provisional motion as a provisional desired motion of the desired 
gait; and 

provisional motion correcting means for correcting the 
provisional motion and determining a motion of the desired gait 
by varying an angular momentum changing rate of the robot about 
the center of gravity in the provisional motion while restricting 
restriction object amount which is defined according to the 
provisional motion of the desired gait to the permissible range 
if the restriction object amount has deviated from the 
permissible range (Claim 48) . 

[0078] 

According to the fifth aspect of the gait generation device, 
the desired gait can be generated so that the restriction object 
amount related to the vertical component of the friction force 
will not surpass the permissible range in accordance with the 
deter-nination result of the occurrence of the robot; thereby, 
it is possible to prevent the robot from spinning and falling 
caused by a spin. 

[0079] 

-59- 



Arjcording to a fourth aspect of a control device of the 
present invention, there is provided a control device of a legged 
mobile robot adapted to sequentially determine instantaneous 
values of a desired motion and a desired floor reaction force 
of a legged mobile robot that travels by moving legs extended 
from its body by using a dynamic model that expresses a 
relationship between at least a motion of the robot and a floor 
reaction force, and also to control an operation of the robot 
at the same time so as to make the robot follow the determined 
instantaneous values of the desired motion and the desired floor 
reaction force, comprising: 

slippage determining means for determining the occurrence 
of a slippage of the robots- 
permissible range setting means for variably setting a 
permissible range of a restriction object amount according to 
a determination result of the slippage determining means, the 
restriction object amount being a lateral component of a 
trans lational floor reaction force applied to the robot or a floor 
parallel component of the t r ans lat iona 1 floor reaction force or 
a lateral component of acceleration of the overall center of 
gravi -y of the robot or a floor parallel component of acceleration 
of the overall center of gravity; and 

desired instantaneous value determining means for 
determining a new instantaneous value of the desired motion on 
the basis of a deviation between at least a desired state amount 
of a posture of the robot corresponding to the determined 
instantaneous value of the desired motion and an actual state 
amount, of the robot so that the restriction object amount 
determined according to the new instantaneous value and the 
dynamic model is restricted to the permissible range (Claim 49) . 
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[0080] 

According to the control device of the fourth aspect, the 
restriction object amount related to the lateral component of 
the friction force is configured not to surpass the permissible 
5 range in accordance with the determination result of the 
occurrence of the robot; thereby, it is possible to prevent the 
robot from spinning and falling caused by a spin. 

[0081] 

H) [Best Mode for Carrying Out the Invention] 

Referring now to the accompanying drawings, control devices 
of legged mobile robots according to embodiments of the present 
invention will be explained. As the legged mobile robots, 
bipedal mobile robots will be used as examples. 

15 [0082] 

Fig. 1 is a schematic diagram generally showing a bipedal 
mobile robot representing a legged mobile robot according to the 
present embodiment. 

[0083] 

20 As shown in the figure, a bipedal mobile robot (hereinafter 

referred to as ^'the robot") 1 is equipped with a pair of right 
and left legs (leg links) 2, 2 provided such that they extend 
downward from a body (a base body of the robot 1) 3. The two 
legs 2, 2 share the same construction, each having six joints. 

25 The six joints of each leg are comprised of, in the following 
order from the body 3 side, joints lOR, lOL (symbols R and L 
meaning correspondence to the right leg and the left leg, 
respectively; the same will be applied hereinafter) for swinging 
(rotating) a hip (waist) (for rotating in a yaw direction relative 

30 to the body 3), joints 12R, 12L for rotating the hip (waist) in 
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a roi- direction {about an X axis), joints 14R, 14L for rotating 
the hip (waist) in a pitch direction (about a Y axis), joints 
16R, 16L for rotating knees in the pitch direction, joints 18R, 
18L for rotating ankles in the pitch direction, and joints 20R, 
5 20L for rotating the ankles in the roll direction. 
[0084] 

A foot (foot portion) 22R (L) constituting a distal portion 
of each leg 2 is attached to the bottoms of the two joints 18R 
(L) and 2 OR (L) of the ankle of each leg 2 . The body 3 is installed 

10 at the uppermost top of the two legs 2, 2 through the intermediary 
of the three joints lOR (L), 12R (L) and 14R (L) of the hip of 
each J eg 2 . A control unit 60 or the like, which will be discussed 
in d€^tail hereinafter, is housed inside the body 3. For 
convenience of illustration, the control unit 60 is shown outside 

15 the body 3 in Fig. 1. 
[0085] 

In each leg 2 having the aforesaid construction, a hip joint 
(or a waist joint) is formed of the joints lOR (L), 12R (L) and 
14R ( u) , the knee joint is formed of the joint 16R (L), and the 
20 ankle joint is formed of the joints 18R (L) and 20R (L) . The 
hip joint and the knee joint are connected by a thigh link 24R 
(L), and the knee joint and the ankle joint are connected by a 
crus link 26R (L) . 
[0086] 

25 A pair of right and left arms 5, 5 is attached to both sides 

of an upper portion of the body 3, and a head 4 is disposed at 
a top end of the body 3. Each arm 5 is provided with a shoulder 
joint composed of three joints 30R (L), 32R (L), and 34R (L) an 
elbow joint composed of a joint 36 R(L), a wrist joint composed 

30 of a joint 38R (L), and a hand 40R (L) connected to the wrist 
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joint. The head 4 is not directly connected to a topic of the 
present invention, so that detailed explanation thereof will be 
omi tted . 

[0087] 

5 According to the construction described above, the foot 22R 

(L) of each leg 2 is given six degrees of freedom relative to 
the body 3. During a travel, such as walking, of the robot 1, 
desired motions of the two feet 22R and 22L can be accomplished 
by driving 6*2 = 12 joints of the two legs 2, 2 together (^'*" in 

10 the present description will denote multiplication as scalar 
ca leu 1 cit i on , while it will denote an outer product in vector 
calculation) at appropriate angles. This arrangement enables 
the robot 1 to arbitrarily move in a three-dimensional space. 
Furthermore, each arm 5 can perform a motion, such as arm swinging, 

15 by ro'iating its shoulder joint, the elbow joint, and the wrist 
j oint . 

[0088] 

As shown in Fig. 1, a publicly known six-axis force sensor 

50 is provided between the ankle joints 18R (L) , 20R (L) and the 
20 foot 2.2R (L) of each leg 2. The six-axis force sensor 50 detects 
primarily whether the foot 22R (L) of each leg 2 is in contact 
with the ground, and a floor reaction force (landing load) acting 
on each leg 2, and it outputs detection signals of three-direction 
components Fx, Fy, and Fz of a translational force of the floor 
25 reaction force and three-direction components Mx, My, and Mz of 
a moment to the control unit 60. Furthermore, the body 3 is 
equipped with a posture sensor 54 for detecting an inclination 
angle of the body 3 relative to a Z-axis (vertical direction 
(gravjLtational direction) ) and an angular velocity thereof, and 
30 a rot^itional angle (yaw angle) of the body 3 about the Z-axis 
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and ar. angular velocity thereof, detection signals thereof being 
output from the posture sensor 54 to the control unit 60. The 
posture sensor 54 is provided with a three-axis direction 
accelerometer and a three-axis direction gyro sensor. These 
5 detection signals of these sensors are used to detect posture 
angles (an inclination angle and a yaw angle) of the body 3 and 
an angular velocity thereof, and also used to estimate a self 
position/posture of the robot 1. Although detailed structures 
are not shown, each joint of the robot 1 is provided with an 

10 electric motor 64 (refer to Fig. 3) for driving the joint, and 
an encoder (rotary encoder) 65 (refer to Fig. 3) for detecting 
a rotational amount of the electric motor 64 (a rotational angle 
of ea(-h joint) . Detection signals of the encoder 65 are output 
from the encoder 65 to the control unit 60. 

15 [0089] 

Furthermore, although not shown in Fig. 1, a joystick 
(operating device) 73 (refer to Fig. 3) is provided at an 
appropriate position of the robot 1. The joystick 73 is 
constructed in such a manner that a request regarding a gait of 
20 the robot 1, such as a request for turning the robot 1 that is 
moving straight, is input to the control unit 60 as necessary 
by operating the joystick 73- 
[0090] 

Fig. 2 is a diagram schematically showing a basic 
25 construction of a distal portion (including each foot 22R (L) ) 
of each leg 2 in the present embodiment. As shown in the diagram, 
a spring mechanism 70 is installed between each foot 22R (L) and 
the six-axis force sensor 50, and a foot sole elastic member 71 
made of rubber or the like is bonded to a foot sole (the bottom 
30 surface of each foot 22R (L) ) . These spring mechanism 70 and 
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the foot sc)le elastic member 71 constitute a compliance mechanism 
72. The spring mechanism 10, which will be discussed in detail 
later, is constructed of a square guide member (not shown) , which 
is installed on the upper surface of the foot 22R (L) , and a 
5 piston-shaped member (not shown) installed adjacently to the 
ankle joint 18R (L) (the ankle joint 20R (L) being omitted in 
Fig. 2 ) and the six-axis force sensor 50, and housed in the guide 
member through the intermediary of an elastic member (rubber or 
spring) so that it may be jogged. 
10 [3091] 

Tne foot 22R (L) indicated by a solid line shown in Fig. 2 
is in a state where it is subjected to no floor reaction force. 
When each leg 2 is subjected to a floor reaction force, the spring 
mechanism 70 and the foot sole elastic member 71 of the compliance 

15 mechanism 72 flex, causing the foot 22R (L) to shift to the 
posit ion/posture illustrated by a dashed line in the figure . The 
struc::ure of the compliance mechanism 72 is important not only 
to ease a landing impact but also to enhance controllability, 
as explained in detail in, for example, Japanese Unexamined 

20 Patent Publication Application No . 5- 3 055 8 4 previously proposed 
by the present applicant. 
[0092 ] 

Fig. 3 is a block diagram showing a construction of the 
control unit 60. The control unit 60 is comprised of a 

25 microcomputer, and includes a first calculator 90 and a second 
calculator 92 formed of CPUs, an A/D converter 80, a counter 86, 
a D/A converter 96, a RAM 84, a ROM 94, and a bus line 82 for 
transferring data among them. In the control unit 60, output 
signals of the six-axis force sensor 50, the posture sensor 54 

30 (an ac:celerometer and a rate gyro sensor) , the joystick 73, etc. 
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of each leg 2 are converted into digital values by the A/D 
converter 80 and sent to the RAM 84 via the bus line 82. Outputs 
of the encoder 65 (rotary encoder) of each joint of the robot 
1 are supplied to the RAM 84 via the counter 86. 
5 [0093] 

As will be discussed hereinafter, the first calculator 90 
generates desired gaits, calculates a joint angle displacement 
command (a displacement angle of each joint or a command value 
of a lotational angle of each electric motor 64), and sends the 

10 calculation result to the RAM 84. The second calculator 92 reads 
an actual measurement value of a joint angle detected on the basis 
of the joint angle displacement command and an output signal of 
the encoder 65 from the RAM 84 to calculate a manipulated variable 
required for driving each joint, and outputs the calculated 

15 variaole to the electric motor 64 for driving each joint through 
the intermediary of the D/A converter 96 and a servo amplifier 
64a . 

[0094] 

Fig. 4 is a block diagram showing the entire functional 
20 construction of a control unit of the legged mobile robot in 
accordance with the present embodiment. A portion except for 
the ^'actual robot" in Fig. 4 is constituted by processing 
functions implemented by the control unit 60 (primarily the 
functions of the first calculator 90 and the second calculator 
25 92) . In the following explanation, the symbols R and L will be 
omitted as long as it is not particularly necessary to 
discriminate right and left of the legs 2 and the arms 5. 
[ 0095] 

The explanation will now be given. The control unit 60 is 
30 equipped with a gait generator 100 for generating and outputting 
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desired gaits of the robot 1 freely and in real time. The 
functions of the gait generator 100 constitute individual means 
of the present invention. A desired gait output by the gait 
generator 100 is constituted of a desired body position/posture 
5 trajectory (trajectory of a desired position and a desired 
postures of the body 3), a desired foot position/posture 
trajectory (trajectory of a desired position and a desired 
posture of each foot 22), a desired arm posture trajectory 
(trajectory of a desired posture of each arm 5) , a desired total 

10 floor reaction force central point (desired ZMP) trajectory, and 
a desired total floor reaction force trajectory. If a movable 
part relative to the body 3 is provided in addition to the legs 
2 c'ind the arms 5, then a desired position/posture trajectory of 
the m(3vable part is added to the desired gait. 

15 [(30961 

Here, the term "trajectory" in the above gait means a 
temporal change pattern (time series pattern), and may be 
referred to as '"pattern" in place of "tra j ectory" in the following 
explanation. Furthermore, a "posture" of each part means a 

20 spatial orientation. For example, a posture of a body is 
represented by an inclination angle of the body 3 in the roll 
direction (about the X-axis) relative to the Z-axis (vertical 
axis) , an inclination angle of the body 3 in the pitch direction 
(about the Y-axis) , and a rotational angle (yaw angle) of the 

25 body 3 in the yaw direction (about the Z-axis) . A foot posture 
:ls represented by means of a spatial azimuth of two axes fixedly 
set on each foot 22. In the present description, a body posture 
may be? referred to as a body posture angle. 
[0097] 

>0 In the following explanation, the term "desired" will be 
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frequently omitted when there is no danger of misunderstanding. 
Furthermore, among gaits, those gaits related to constituent 
elements other than those related to a floor reaction force, that 
is, the gaits related to motions of the robot 1, such as a foot 
5 position/posture and a body position/posture, will be 
collectively referred to as ^'motion.'' A floor reaction force 
(floor reaction force comprised of a translational force and the 
moment) of each foot 22 is referred to as ^""each-foot floor 
reaction force'', and a resultant force of the ^^each-foot floor 

10 reaction forces" of all (two) feet 22R and 22L of the robot 1 
will be referred to as a "total floor reaction force" . In the 
following explanation, however, each-foot floor reaction force 
will hardly be referred to, so that '^floor reaction force" will 
be handled as having the same meaning as "total floor reaction 

15 force" unless otherwise specified. 
[ 3098 I 

A desired floor reaction force is generally expressed by a 
point of action and a translational force and the moment acting 
on the point. The point of action may be set at any location, 

20 so that innumerable expressions are possible for the same desired 
floor reaction force. If, however, a desired floor reaction 
force is expressed using especially the aforesaid desired floor 
reaction force central point (a desired position of the floor 
reaction force central point) as the point of action, then the 

25 moment, component of the desired floor reaction force will be zero 
except for a vertical component (the moment about the vertical 
axis (Z-axis) ) . In other words, the horizontal component of the 
moment: of the desired floor reaction force about the desired floor 
reaction force central point (the moment about the horizontal 

30 axis ;the X-axis and the Y-axis)) will be zero. 
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[ J 0 9 9 1 

I '1 the case of a gait that satisfies dynamic balance 
conditions, a ZMP calculated from a desired motion trajectory 
of th€i robot 1 (a point at which the moment of a resultant force 
5 of an inertial force and gravity calculated from the desired 
motio]! tr£ijectory acts about the point becomes zero except for 
a vertical component) agrees with a desired floor reaction force 
central point. Therefore, providing a desired ZMP trajectory 
may be regarded as equivalent to providing a desired floor 
10 reaction force central point trajectory (refer to, for example, 
Japanese Patent Application No. 2000-352011 by the present 
appli<rant for more details) . 
[ 3 10 0 1 

Fcom the background described above, in the description of 
15 Japanese Patent Application No. 2000-352011, a desired gait has 
been defined as follows. 

a) In a broad sense, a desired gait is a combination of a desired 
motion trajectory and a desired floor reaction force trajectory 
thereof in a period of one step or a plurality of steps. 

20 b) In .a narrow sense, a desired gait is a combination of a desired 
motion trajectory and a ZMP trajectory thereof in a period of 
one si:ep, 

c) A se^ries of gaits is formed of several gaits that are connected. 

[0101] 

25 In walking, a vertical position of the body 3 of the robot 

1 (a height of the body) is determined by a body height determining 
rechn:_que proposed previously in Japanese Unexamined Patent 
Application Publication No. 10-86080 by the present applicant. 
This subordinately determines a translational floor reaction 
30 force vertical component. Furthermore, a translational floor 
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reaction force horizontal component is also determined by 
deteriaining the horizontal body position trajectory of the robot 
1 sucl-i that the horizontal component of the moment produced about 
a des:_red ZMP by a resultant force of the inertial force and the 
5 gravity generated by the motion of a desired gait becomes zero. 
For this reason, a des:Lred ZMP alone has been adequate as a 
physical amount to be explicitly set for the floor reaction force 
of a desired gait in the description of Japanese Patent 
Application No. 2000-352011. Thus, the definition in the above 

10 b) has been adequate as the definition of a desired gait in the 
narrow sense. However, in the running gait of the robot 1 
explained in the present embodiment (the details will be 
described hereinafter) , a floor reaction force vertical 
component (a translational floor reaction force vertical 

15 component) is also important for control. In the present 
invention, therefore, a desired trajectory of the floor reaction 
force vertical component is explicitly set, and then a trajectory 
of a desired vertical body position or the like of the robot 1 
is det:ermined. Hence, in the present description, the following 

20 b' ) W1.11 be adopted as the definition of a desired gait in a narrow 
sense . 

b' ) A desired gait in a narrow sense is a combination of a desired 
motion trajectory and a desired floor reaction force trajectory 
including at least a ZMP trajectory of the desired motion 
25 trajectory and a desired translational floor reaction force 

vertical component trajectory in a period of one step. 
[0102] 

In the present description, a desired gait used hereinafter 
will mean the desired gaits in the narrow sense of the above b' ) 
30 unless otherwise specified for the purpose of easy understand. 
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In this case, ''one step'' of a desired gait will mean a period 
from "he moment one leg 2 of the robot 1 touches the ground to 
the moment the other leg 2 touches the ground. In the following 
explancition, ""f loor reaction force vertical component'' will mean 
5 " translat ional floor reaction force vertical component, " and the 
term '"moment" will be used for the vertical component (the 
compoient about the vertical axis) of a moment of a floor reaction 
force so as to distinguish it from the "floor reaction force 
vertical component." Similarly, "floor reaction force 
10 horizontal component" will mean "translational floor reaction 
force horizontal component." 
[3103 1 

Needless to say, a double stance period in a gait will refer 
to a period during which the robot 1 supports its own weight by 

15 the two legs 2, 2. A single stance period will refer to a period 
during which the robot 1 supports its own weight only by one leg 
2f anc. a floating period will refer to a period during which both 
legs 2, 2 are apart from a floor (floating in the air) . In the 
single stance period, the leg 2 not supporting the self-weight 

20 of the robot 1 will be referred to as a "free leg." The running 
gait explained in the present embodiment does not have the double 
stance period, but alternately repeats the single stance period 
(landiLng period) and the floating period. In this case, during 
the floatd.ng period of running, both legs 2, 2 do not support 

25 Che s€5lf-weight of the robot 1; however, the leg 2 that was a 
free leg and the leg 2 that was a supporting leg during a single 
stance period immediately before the floating period will be 
referred to as a "free leg" and a "supporting leg, " respectively, 
even in the floating period. 

30 [0104] 
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Taking the running gait shown in Fig. 5 as an example, an 
outline of a desired gait generated by the gait generator 100 
will be explained. More definitions and details related to gaits 
have been given also in Japanese Unexamined Patent Application 
5 Publication No. 10-86081 previously proposed by the present 
applirant, so that the following will mainly give a description 
not covered by the Japanese Unexamined Patent Application 
Publication No. 10-86081. 
[ 0105] 

10 First, the running gait shown in Fig. 5 will be explained. 

This running gait is a gait similar to a typical human running 
gait. In this running gait, the single stance period in which 
the foot 22 of only either the right or left leg 2 (supporting 
leg) of the robot 1 lands (contacts the ground) and a floating 

15 period in which both the legs 2, 2 float in the air are alternately 
repeated. In Fig. 5, the first state illustrates a state wherein 
a single stance period has begun (initial stage) , the second state 
illustrates a state of a midpoint of the single stance period, 
the third state illustrates a state wherein a floating period 

20 following the single stance period has begun (an end of the single 
stance period) , the fourth state illustrates a state of a midpoint 
of the.' floating period, and the fifth state illustrates an end 
of the floating period (a start of the next single stance period) . 
[ (n 0 6 ] 

25 In this running gait, the robot 1 lands at the heel of the 

foot 22 of the supporting leg (the leg 2 on the front side in 
the aovancing direction of the robot 1) at the beginning of the 
single stance period, as shown in the first state of Fig. 5. 
Subsequently, the robot 1 brings substantially the entire 

30 surfac:e of the sole of the landed foot 22 (the foot 22 of the 
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supportinq leg) into contact with the ground as shown in the 
second state of Fig. 5, and then kicks the floor with the tiptoe 
of the foot 22 (the foot 22 of the leg 2 on the rear side with 
respect to the advancing direction of the robot 1 in the third 
5 state of Fig. 5) of the supporting leg to jump into the air as 
shown in the third state of Fig. 5. This ends the single stance 
period and starts the floating period at the same time. The free 
leg ir the single stance period exists behind the supporting leg 
at the beginning of the single stance period as shown in the first 

10 state of Fig. 5^ but swung out to the front of the supporting 
leg toward the next predetermined landing position, as shown in 
the s6'Cond and the third states of Fig. 5. Next, following the 
float:Lng period shown in the fourth state of Fig, 5, the robot 
1 lands at the heel of the foot 22 of the free leg (the leg 2 

15 that v;as the free leg in the single stance period immediately 
before^ the floating period started) , and the next single stance 
period is begun. 
[01071 

Cc^nsidering the running gait shown in Fig. 5, a basic outline 
20 of a desired gait generated by the gait generator 100 will be 
expla:-ned. Although more details will be discussed later, when 
the gait generator 100 generates a desired gait, basic required 
values (required parameters) for generating the desired gait, 
such as a landing position/posture (expected landing 
25 position/posture) of the foot 22 of a free leg and a landing time 
(expected landing time), are supplied to the gait generator 100 
according to a required operation or the like of the joystick 
44 . The gait generator 100 then generates the desired gait using 
the re'quired parameters. More detailedly, the gait generator 
30 100 determines parameters (referred to as gait parameters) that 
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specify some constituent elements of the desired gait, such as 
a desxred foot position/posture trajectory and a desired floor 
reaction force vertical component trajectory, on the basis of 
the above required parameters, and then sequentially determines 
5 instantaneous values of the desired gait by using the gait 
parameters so as to generate a time series pattern of the desired 
gait. 

[0108] 

In this case, a desired foot position/posture trajectory (to 

10 be more specific, a desired trajectory of each spatial component 
(X-axis component or the like) of the position and the posture 
of a foot) is generated for each foot 22 by using a finite-duration 
setting filter proposed in Patent No. 3233450 by the present 
applicant. This finite-duration setting filter includes a 

15 plurality of stages (3 states or more in the present embodiment) 
of first-order lag filters of variable time constants, that is, 
filters represented in terms of a transfer function of 1/ (l+Ts) (t 
is a variable time constant. Hereinafter, the filter will be 
referred to as a unit filter) , the plurality of stages of the 

20 filters being connected in series. This arrangement makes it 
possible to generate and output a trajectory that reaches a 
specified value at desired specified time. In this case, every 
rime constant x of the unit filter of each stage is variably set 
in sequence according to remaining time until the above specified 

25 rime after starting the generation of an output of the 
finite-duration setting filter. More specifically, the setting 
is made such that, the value of x is decreased from a predetermined 
initi^al value (>0) as the remaining time reduces, and the value 
of X finally reaches zero at the specified time at which the 

30 remaining time reaches zero. A step input of a height based on 
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the sj^ecified value (more specifically, a change amount from an 
initial value to the specified value of an output of the 
finite-duration setting filter) is supplied to the 
finite-duration setting filter. The finite-duration setting 
5 filter not only generates an output that reaches a specified value 
at specif ied time but also makes it possible to set a changing 
rate of an output of the finite-duration setting filter at 
specified time to zero or substantially zero. Especially when 
three stages or more (three stages will do) of the unit filters 
10 are connected, the changing acceleration (a differential value 
of a changing rate) of an output of the finite-duration setting 
filter can be reduced to zero or substantially zero. 
[0109] 

The desired foot position/posture trajectory generated by 
15 the finite-duration setting filter as described above is the 
desired position/posture trajectory of each foot 22 on a 
supporting leg coordinate system, which is fixed on a floor 
surface and which is to be discussed later. 
[0110] 

20 The desired foot position/posture trajectory generated as 

described above is generated such that the position of each foot 
22 begins moving, while gradually accelerating from the initial 
in-contact-with-the-ground state (the state at the initial time 
of a desired gait) toward an expected landing position. The 

25 desired foot position/posture trajectory is generated such that 
the changing rate of the position is gradually decelerated to 
zero or substantially zero until the expected landing time is 
finally reached, and the expected landing position is reached 
at the expected landing time, stopping the movement. Hence, the 

30 ground speed at the moment each foot 22 lands becomes zero or 
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substantially zero {the changing rate of the position of each 
foot 22 on the supporting leg coordinate system secured to a 
floor) . Accordingly, a landing impact will be low even when the 
robot 1 lands from the state wherein all legs 2, 2 are 
5 simultaneously present in the air (the state in the floating 
period) in a running gait. 
[OlllJ 

In the aforesaid running gait, the vertical velocity of the 
body .3 switches downward from the latter half of the floating 

10 period due to the gravity acted on the robot 1, and remains 
downward at the time of landing. Therefore, the relative 
velocity of the foot 22 of a free leg with respect to the body 
3 swit-ches upward immediately before landing if the desired foot 
pos i t ion /posture trajectory is generated such that the ground 

15 speed at the moment each foot 22 lands reaches zero or 
substantially zero, as described above, and if the desired 
posit Ion /posture trajectory of the body 3 is generated to satisfy 
a dynamic balance condition, as will be discussed later. This 
means that the desired gait of the robot 1 is such that the robot 

20 1 lands, withdrawing the leg 22 that is a free leg toward the 
body 3. In other words, according to the desired gait in the 
present embodiment, the robot 1 lands while pulling the foot 22 
up, as observed from the body 3, so that the ground speed of the 
foot 22 of the free leg reaches zero or substantially zero. This 

25 restrains a landing impact to prevent the landing impact from 
becoming excessive. 
[0112 I 

Furthermore, in the present embodiment, the finite-duration 
setting filter is composed of three stages of more (e.g., three 
30 stages) of the unit filters connected in series, so that the 
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velocity of each foot 22 (the changing rate of a foot position) 
reaches zero or substantially zero by expected landing time and 
the caccelerat ion of each foot 22 also reaches zero or 
substantially zero at the expected landing time when the movement 
stops . This means that the ground acceleration also becomes zero 
or substantially zero at the landing instant. Hence, the landing 
impact will be further restrained. Especially, even if actual 
landing time of the robot 1 deviates from desired landing time, 
the impact no longer increases much. Supplementally, the number 
of stages of the unit filters of the finite-duration setting 
filter may be two to make setting so that the ground speed of 
each foot 22 reaches zero or substantially zero at expected 
landi]ig time. In this case, however, the acceleration of each 
foot 22 at expected landing time does not usually become zero. 
[ D113 ] 

Regarding a foot posture, after each foot 22 lands at its 
heel Eit expected landing time, the foot continues to move until 
substantially the entire sole of the foot 22 comes in contact 
with ai floor. For this reason, the time at which substantially 
the entire sole of the foot 22 comes in contact with the floor 
is set to the above specified time, and the foot posture 
trajectory is generated by the finite-duration setting filter. 

[0114 J 

In the present embodiment, the foot position trajectory has 
been generated using the finite-duration setting filter. 
Alternatively, however, a desired foot position trajectory may 
be generated using a function, such as a polynomial, that is set 
such that the changing rate of a foot position at the expected 
landing time {a time differential value of a foot position) 
reache^s zero or substantially zero and further the changing 
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accel e^rat ion of the foot position at the expected landing time 
(a time differential value of the changing rate) reaches zero 
or substantially zero. This applies also to the generation of 
a desired foot posture trajectory. However, regarding the 
5 generation of the desired foot posture trajectory, a function, 
such as a polynomial, is set such that the changing rate of the 
posture of each foot 22 and the changing acceleration thereof 
reaches zero or substantially zero at the time when substantially 
the entire sole of each foot 22 comes in contact with a floor, 
10 as described above. 
[0115] 

A desired floor reaction force vertical component trajectory 
is set as shown in, for example. Fig. 6. In the present 
embodiment, the shape of a desired floor reaction force vertical 

15 component trajectory in a running gait (strictly speaking, the 
shape in a single stance period) is specified to be trapezoidal 
(a shape projecting to an increasing side of a floor reaction 
force vertical component) . The height of the trapezoid and the 
time of a bending point are regarded as gait parameters defining 

20 a desired floor reaction force vertical component trajectory, 
and tlie gait parameters (floor reaction force vertical component 
trajectory parameters) are determined. In a floating period of 
a running gait, the desired floor reaction force vertical 
component is steadily set to zero. A desired floor reaction 

25 force vertical component trajectory is desirably set so that it 
is viitually continuous (so that values are not discontinuous), 
as in the case of the p)resent example. This is for ensuring 
smootn operations of joints of the robot 1 when controlling a 
floor reaction force. The term ^'virtually continuous'' means 

30 that a skipped value that inevitably takes place when a trajectory 
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that j.s continuous in an analog fashion (a continuous trajectory 
in a true meaning) is digitally expressed by a discrete- time 
system does not cause the continuity of the trajectory to be lost. 
[0116] 

A desrred ZMP trajectory is set as follows. In the running 
gait shown in Fig. 5, the robot 1 lands at the heel of the foot 
22 of a supporting leg, and then kicks at the tiptoe of the foot 
22 of the supporting leg to jump into the air. Lastly, the robot 
1 lands at the heel of the foot 22 of a free leg, as described 
above. Therefore, as shown in the upper diagram of Fig. 7, the 
desired ZMP trajectory in the single stance period is set such 
that :Lt takes the heel of the foot 22 of the supporting leg as 
its initial position, and then extends to the center in the 
longitudinal direction of the foot 22 in the period in which 
subs tcantially the entire sole of the foot 22 of the supporting 
leg comes on contact with the ground, and thereafter, reaches 
the tiptoe of the foot 22 of the supporting leg by floor leaving 
time. Here, the upper diagram of Fig. 7 shows a desired ZMP 
trajectory in an X-axis direction (longitudinal direction), 
while a lower diagram of Fig. 7 shows a desired ZMP trajectory 
in a Y-axis direction (lateral direction). The desired ZMP 
trajecrtory in the Y-axis direction in a single stance period is 
set at the same position as the central position of an ankle joint 
of a supporting leg 2 in the Y-axis direction, as shown in the 
lower diagram of Fig. 7. 

[0117] 

In a running gait, after a single stance period ends, both 
legs 2 , 2 leave a floor, and the floor reaction force vertical 
component becomes zero. When the floor reaction force vertical 
component is zero, that is, during a floating period, the total 
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center of gravity of the robot 1 is subject to free fall motion, 
and an angular momentum change about the total center of gravity 
is ze2"o. At this time, the moment of a resultant force of gravity 
and an inertial force that acts on the robot 1 is zero at an 
5 arbitrary point of a floor, so that a desired ZMP is indefinite. 
This means that any point of the floor satisfies a condition of 
ZMP represented by ''a point of action at which the horizontal 
component of the moment, in which a resultant force of gravity 
and an inertial force acts, is zero.'' In other words, setting 

10 the desired ZMP at an arbitrary point satisfies a dynamic balance 
condition in that the horizontal component of the moment in which 
the above resultant force acts about the desired ZMP is zero. 
Hence, the desired ZMP may be set discontinuously . For example, 
the desired ZMP may be set so that it does not move from a desired 

15 ZMP position when leaving a floor {wh€m a single stance period 
ends) in a floating period, and it moves discontinuously (in 
steps) to a desired ZMP position for landing at the end of the 
floating period. In the present embodiment, however, the 
position of the desired ZMP trajectory in the X-axis direction 

20 in a floating period has been set so as to continuously move to 
the landing position of the heel of the foot 22 of a free leg 
from t,he tiptoe of the foot 22 of a supporting leg by the time 
the next free leg 2 lands, as shown in the upper diagram of Fig. 
7. Further, as shown in the lower diagram of Fig . 7, the position 

25 of the desired ZMP trajectory in the Y-axis direction in a 
float:_ng period has been set so as to continuously move to the 
Y-axis directional position of the center of the ankle joint of 
a free? leg from the Y-axis directional position of the center 
of the. ankle joint of a supporting leg 2 by the time the next 

30 free J.eg 2 lands. In other words, the desired ZMP trajectory 
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has been set so that it is continuous (virtually continuous) in 
all periods of a gait. As it will be discussed hereinafter, a 
desired gait has been generated so that a moment of the resultant 
force of gravity and an inertial force (excluding a vertical 
5 component) about the desired ZMP becomes zero { to be more speci f ic , 
a des:.red body position/posture trajectory has been adjusted) . 
Taking an approximation error into account, the desired ZMP 
trajectory is desirably set to be continuous (virtually 
continuous) also in a floating period in order to ensure a smooth 

10 generated gait. However, a dynamic model, which is used in the 
present embodiment and which will be discussed later, makes it 
possible to uniquely generate a desired gait that sets the 
horizontal component of a moment about a desired ZMP at a certain 
value (the value is zero in the present embodiment, whereas it 

15 is not: necessarily zero in embodiments, which will be described 
hereinafter) independently of the position of a desired ZMP. 
Therefore, the desired ZMP does not have to be always continuous. 
[ 3118 ] 

In the present embodiment, the positions and time of the 
20 bending points of the desired ZMP trajectory as shown in Fig. 
7 are set as ZMP trajectory parameters (parameters defining the 
desired ZMP trajectory) . The meaning of "virtually continuous" 
of the aforementioned ZMP trajectory is the same as that in the 
case of the above floor reaction force vertical component 
25 trajec:tory. 

[ 0 1 1 9 J 

The ZMP trajectory parameters are determined such that a high 
stability margin is secured and no sudden change takes place. 
Here, a state in which a desired ZMP exists near the center of 
30 a least convex polygon (so-called supporting polygon) that 
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includes a ground contact surface of the robot 1 indicates a high 
stabilLty margin (refer to Japanese Unexamined Patent 
Application Publication No. 10-86081 for more detail). The 
desired ZMP trajectory shown in Fig. 7 has been set to meet such 
a condition. 
[0120] 

A desired body position/posture, a desired foot 
position/posture, and a reference body posture, which will be 
discussed hereinafter, are described in terms of a global 
coordinate system. The global coordinate system is a coordinate 
system fixed to a floor. More specifically, a supporting leg 
coordinate system to be discussed hereinafter is used as the 
global coordinate system. 

[3121] 

In the present embodiment, the gait generator 100 generates 
a reference body posture in addition to a desired body posture. 
The re.'ference body posture is a body posture generated directly 
on th€: basis of requests regarding a gait (requests from a unit, 
such as an action scheduler, or from an external source (the 
joystick 44 or the like) sent to the gait generator 100). 

[ 012 2 1 

A desired body posture (representing hereinafter a desired 
body posture unless ''reference'' is added) is generated such that 
it follows or agrees with a reference body posture in a long term. 

[(3123] 

In walking, generally, a desired body posture may be always 
set tc agree with a reference body posture as in the case of an 
embodiment disclosed in the description of Japanese Patent 
Application No. 2000-352011. Although the Japanese Patent 
Applic:ation No. 2000-352011 does not irefer- to the concept of the 
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reference body posture, it explicitly and preferentially gives 
desired body posture patterns, which is equivalent to steady 
agreement of desired body postures with a reference body posture . 

[ 0 2 4 1 

5 However, in a gait including a floating period, as in running, 

or waj.kinq on a low-friction floor surface, simply adjusting a 
body horizontal acceleration or the like is not enough to satisfy 
a dyncimic balance condition while maintaining a floor reaction 
force horizontal componemt and a floor reaction force vertical 
10 component of a desired gait within a permissible range (or within 
a fricztion limit) at the same time. 
[01251 

In the present embodiment, therefore, a desired body posture 
is deliberately deviated from a reference body posture, as 
15 necessary. To be more specific, motion modes explained below 
are generated in a combined manner so as to satisfy the dynamic 
balance condition while having a floor reaction force horizontal 
component and a floor reaction force moment vertical component 
of a desired gait falling within a permissible range (or within 
20 a friction limit) . 
[01261 

A;3 shown in Fig. 8, when the robot 1 is in a certain motion 
state, if only a body horizontal acc€5leration is perturbated 
(slightly changed), a total center-of -gravity horizontal 

25 acceleration and an angular momentum about the total 
center-of -gravity of the robot 1 are perturbated. More 
specifically, perturbating the body horizontal acceleration 
perturbates the floor reaction force moment horizontal component 
about a desired ZMP (a component about the horizontal axis) and 

30 rhe floor reaction force horizontal component without 
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perturbating the floor reaction force vertical component that 
dynamically balances with a resultant force of an inertial force 
and gravity of the robot 1 produced by the perturbation of the 
body horizontal acceleration (without perturbating a total 
5 cente r-of-gravity vertical acceleration of the robot 1). The 
motioi mode that perturbs the body horizontal acceleration of 
the robot 1 as described above is referred to as a body 
trans Lational mode. (Note that the floor reaction force moment 
vertical component is also perturbated; however, no attention 

10 will be paid to this aspect in this case.) 

In other words, a motion in which the floor reaction force 
momen" horizontal component about the desired ZMP and the floor 
reaction force horizontal component are changed without changing 
the floor reaction force vertical component is referred to as 

15 the body trans lational mode. In the body translational mode, 
the floor reaction force moment vertical component (As mentioned 
above^ the floor reaction force moment vertical component is also 
perturbated . ) 

A change in the floor reaction force moment horizontal 
20 component per unit acceleration at this time is denoted by AMp 
and a change in the floor reaction force horizontal component 
per unit acceleration is denoted by AFp. If the body 3 is 
horizontally accelerated forward in the situation illustrated 
in Fig. 8, then AMp and AFp act in the directions of the arrows 
25 shown in Fig. 8. 
[0127] 

To facilitate perceptual understanding, the floor reaction 
force that balances with the resultant force of an inertial force 
and gravity generated by a motion has been used for expression. 
30 However, it is theoretically more accurate to express using the 
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resultant force of an inertial force and gravity. The above 
resultant force and the floor reaction force have the same 
magnitude but opposite directions. 
[0128] 

la comparison with the above, if the body inclination angular 
acceleration (the angular acceleration of the inclination angle 
of the body 3) is perturbated about a certain point Pr from a 
certain motion state of the robot 1, as shown in Fig. 9, then 
the angular momentum (excluding the component about the vertical 
axis) about the total center-of -gravity is perturbated, while 
the total center-of -gravity of the robot 1 is not perturbated. 
This means that perturbating the body inclination angle 
acceleration about the point Pr perturbates the floor reaction 
force mome^nt horizontal component about a desired ZMP without 
perturbating the floor reaction force vertical component and the 
floor reaction force horizontal component. The motion mode in 
which the body inclination angle acceleration of the robot 1 is 
perturbated as describe^d above is referred to as the body 
inclination mode. 

[0129 1 

In other words, the motion in which the floor reaction force 
moment horizontal component about a desired ZMP is changed 
without changing a floor reaction force vertical component and 
a floor reaction force horizontal component is called the body 
inclination mode. 

[013 0] 

A change in the floor reaction force moment horizontal 
component per unit angular acceleration at this time is denoted 
by AMr and a change in the floor reaction force horizontal 
component per uni t angular acceleration is denoted by AFr . AFr 
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xs zero. If an angular acceleration of a body inclination angle 
is generated to cause the body 3 to lean forward in the situation 
shown in Fig. 9, then AMr acts in the direction of the arrow shown 
in Fig. 9. 
[0131] 

Further, if a body yaw angle acceleration (the rotational 
angular acceleration about the vertical axis of the body 3) is 
perturbated about a certain point Pq from a certain motion state 
of the robot 1, as shown in Fig. 39, then the angular momentum 
vertical component about the total center-of -gravity is 
perturbated, while the total center-of -gravity of the robot 1 
is not perturbated. Incidentally, if the total 

center-of -gravity of the robot 1 is not perturbated, then the 
perturbation of the angular momentum vertical component does not 
depend on a point of action. Hence, perturbating the body yaw 
angular acceleration about the point Pq perturbates the floor 
reaction force moment vertical component about a desired ZMP 
without perturbating the floor reaction force vertical component, 
the floor reaction force horizontal component, and the floor 
reaction force moment horizontal component. The motion mode in 
which the body yaw angular acceleration of the robot 1 is 
perturbated as described above is referred to as the body yaw 
rotation mode. 

[0132] 

In other words, the body motion in which the floor reaction 

force moment vertical component about a desired ZMP is changed 
without changing a floor reaction force vertical component, a 
floor reaction force horizontal component, and a floor reaction 
force moment horizontal component is called the body yaw rotation 
mode . 
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[0133] 

A change in the floor reaction force moment vertical 
compoaent per unit angular acceleration at this time is denoted 
by AMoz, and a change in the floor reaction force horizontal 
5 component per unit angular acceleration is denoted by AFb . AFb 
is zeiro. If the body 3 is rotated in the direction of the arrow 
at the unit angular acceleration (rotated at an angular 
acceleration |3b=l) in the situation shown in Fig. 39, then AMbz 
acts in the direction of the arrow shown in Fig. 39. 
10 [3134] 

In the motion shown in Fig. 39, the body 3 has been rotated 
so that the positions of the distal ends of both arms 5, 5 remain 
unchaiiged as observed from the supporting leg coordinate system 
(the c:oordinate system fixed to a floor) . However, a motion in 

15 which an arm 5 is rotated together with the body 3 without changing 
the rc^lative position/posture of the arm 5 in relation to the 
body 3 may be defined as the body yaw rotation mode. In this 
case, however, a motion equation to be discussed hereinafter has 
to be slightly changed. 

20 [Ln35| 

Further, if the distal ends of both arms are perturbated 
longitudinally in opposite directions from each other from a 
motion state of the robot 1, as illustrated in Fig. 40, then the 
angul^ir momentum vertical component about the total 

25 center-of -gravity is perturbated, while the total 
cente2:-of -gravity of the robot 1 is not perturbated. 
Hereinafter, this motion mode will be referred to as an antiphase 
arm swing mode. In other words, the arm swing motion mode in 
which the floor reaction force moment vertical component about 

30 a desired ZMP is perturbated without perturbating a floor 
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reaction force vertical component, a floor reaction force 
horizDntai component, and a floor reaction force moment 
horizontal component is referred to as the antiphase arm swing 
mode . 
5 [0136] 

A motion in which a right arm is moveid forward by a unit amount 
and a left arm is moved backward by a unit amount is referred 
to as an antiphase arm swing of a unit angle. Fig. 40 illustrates 
a state wherein an antiphase arm swing angle is 8az. 
10 [01371 

A change in the floor reaction force moment vertical 
component per unit angular acceleration in the antiphase arm 
swing mode is denoted by AMaz, and a change in the floor reaction 
force horizontal component per unit angular acceleration is 

15 denoted by AFa. AFa is zero. In the situation shown in Fig. 
40, i:: the right arm 5R is accelerated forward, while the left 
arm is accelerated backward (swinging at an angular 

acceleration pa>0), then a floor reaction force moment vertical 
component Maz acts in the direction of the arrow (a positive 

20 direcnion of the vertical axis) shown in Fig. 40. 
[01381 

A description will now be given of a dynamic model of the 
robot 1 used in the present embodiment. In the present 
embodiment, a simplified (approximated) dynamic model shown 

25 below is used . However, regarding the dynamic model shown below, 
a kinematics model (a model representing the structures and 
dimensions of joints and links, i.e., a model representing a 
relationship between joint displacements and the 
positions/postures of links) will be also necessary. 

30 [0139] 
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Fig. 10 shows a dynamic model of the robot 1 used in the 
present embodiment. As illustrated^ the dynamic model is a model 
composed of a total of three mass points, namely, two mass points 
2m, 2m corresponding to the legs 2 of the robot 1 and a mass point 
3m corresponding to the body 3, and four flywheels FHx, FHy, FHbz, 
and FHaz having inertias but no mass. This dynamic model is 
decoupled, that is, the dynamic model is constructed such that 
the dynamics (the dynamics of the mass points 2m, 2m) of the legs 
2, 2, the dynamics of the body 3 (the dynamics of the mass point 
3m and the flywheels FHx, FHy and FHbz) , and the dynamics of the 
arms 5, 5 (the dynamics of the flywheel FHaz) do not interfere 
with each other, and the dynamics of the entire robot 1 is 
represented by their linear connection. In addition, a 
relationship between a motion of the body 3 and a floor reaction 
force is separated into a relationship between a translational 
motion of the body 3 (body trans lation mode ) and a floor reaction 
force, a relationship between an inclination motion of the body 
3 (body inclination mode) and a floor reaction force, a 
relat :_onship between a yaw rotational motion of the body 3 (body 
yaw rotation mode) and a floor reaction force, and a relationship 
betweem an antiphase arm swing motion of both arms 5, 5 (antiphase 
arm swing mode) and a floor reaction force. To be more specific, 
a floor reaction force generated by a horizontal motion of the 
body mass point 3m corresponds to a floor reaction force generated 
by a horizontal translational motion of the body 3 (body 
translation mode), and a floor reaction force generated by a 
rotatD.onal motion of the flywheels FHx and FHy corresponds to 
a floc)r reaction force generated by a rotational motion of an 
inclination angle of the. body 3 (body inclination mode). The 
rotational motion of the flywheel FHx corresponds to the 
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rotationai motion of an inclination angle of the body 3 in the 
roll direction (about the X-axis) , and the rotational motion of 
the flywheel FHy corresponds to the rotational motion of an 
inclination angle of the body 3 in the pitch direction {about 
5 the y--axis) . A floor reaction force generated by the rotational 
motion of the flywheel FHbz corresponds to a floor reaction force 
generated by a yaw rotational motion of the body 3 (the body yaw 
rotation mode) . A floor reaction force generated by the 
rotational motion of the flywheel FHaz corresponds to a floor 
10 reaction force generated by an antiphase arm swing motion (the 
antiphase arm swing mode). 
[0140] 

The mass of the arms of the robot 1 is assumed to be included 
in th€B body 3, and the body mass point 3m has a mass that includes 
15 the mass of the arms 5, 5. 
[0141] 

For the convenience of explanation, variables and parameters 
related to the dynamic model will be defined as follows. Each 
of th€e mass points 2m, 2m and 3m corresponds to a representative 

20 point of a part with which it is associated or a point uniquely 
decided geometrically from the position/posture of the part. 
For instance, the position of the mass point 2m of a supporting 
leg 2 is defined as the point above the aforesaid representative 
point of the sole of the foot 22 of the leg 2 by a predetermined 

25 distance. 

Zsup: Supporting leg mass point vertical position 
Zswg: Free leg mass point vertical position 

Zb : Body mass point vertical position (usually different from 
a vertical body position) 
30 ZGtotal: Overall gravitational center vertical position 
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Xsup: S^upporting leg mass point X position 
Ysup: Supporting leg mass point Y position 
Xswg: Free leg mass point X position 
Yswg: Free leg mass point Y position 
5 Xb : Body mass point X position (The body mass point position is 
the position offset by a predetermined distance in the 
longitudinal direction of the body from the aforesaid point Pr . 
The offset is determined such that the gravitational center 
position of an exact model and the gravitational center position 
10 of the present dynamic model agree with each other as much as 
possible in an upright stance or the like. This is usually 
different from a horizontal body position.) 
Yb : Bcxiy mass point Y position 

XGtot ai : Overall gravitational center horizontal X position 
15 YGtotal: Overall gravitational center horizontal Y position 
ebx : Body inclination angle about X-axis relative to vertical 

direc tion 

9by: Body inclination angle about Y-axis relative to vertical 

di rec r:.ion 
20 0bz : 3ody yaw rotational angle 

0az : ;\ntiphase arm swing angle 

mb : Body mass point mass 

msup: Supporting leg mass point mass 

mswg: Free leg mass point mass 
25 mtota L : Total mass of robot (= mtotal + msup + mswg) 

J: Body inertial moment (Equivalent inertial moment in the body 

inclination mode. In other words, this is an inertial moment 

of FHx and FHy. Usually, it does not agree with the inertial 

momen:: of the body 3 part of the actual robot 1.) 
30 Jbz: Body inertial moment about a vertical axis (Equivalent 
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inertial moment in the body yaw rotation mode. Usually, this 
does not agree with the inertial moment of the body 3 part of 
the a::tual robot 1.) 

Jaz: hrm swing inertial moment about a vertical axis (Equivalent 
5 inertial moment in antiphase arm swing to cancel a spin. In other 
words, it is an inertial moment of FHz . ) 

E^x : Floor reaction force X component (More specifically, a 
longitudinal (X-axis) component of a translat ional floor 
reaction force) 

10 Fy : Floor reaction force Y component (More specifically, a 
lateral (Y-axis) component of a translational floor reaction 

force ) 

Fz : Floor reaction force vertical component (More specifically, 

a vertical (Z-axis) component of a translational floor reaction 
15 force. This is equivalent to a desired translational floor 

reaction force vertical component in the present embodiment.) 

Mx : X component of a floor reaction force moment about a desired 

ZMP (More specifically, a component about a longitudinal axis 

(X-axis) of a floor reaction force moment) 
20 My: Y component of a floor reaction force moment about a desired 

ZMP (More specifically, a component about a lateral axis (Y-axis) 

of a floor reaction force moment) 

Mz : Z component of a floor reaction force moment about a desired 
ZMP (More specifically, a component about a vertical axis 
25 (Z-ax.Ls) of a floor reaction force moment) 

[01421 

In the present embodiment, a positional relationship between 
a posi tion of the mass point 2m of each leg 2 and a position of 
the foot 22 of the leg 2 (a position of a predetermined 
30 representative point of the foot 22) is determined in advance. 
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so thu.it one of the posit:. ons is decided, then the other position 
is uni quel y decided . Further, a positional relationship between 
the body mass point 3m and the position of the body 3 (a position 
of a predetermined representative point of the body 3) is 
determined in advance on the basis of a posture angle of the body 
3 (hereinafter, regarding the body, a posture angle will mean 
an inclination angle and a yaw angle) , and if a position and a 
posture angle of one of them are determined, then a position of 
the other is uniquely determined. 
[0143] 

For an arbitrary variable X, dX/dt denotes first order 
differentiation of X, and d2X/dt2 denotes second order 
differentiation. Theirefore, if the variable X denotes 

displacement, then dX/dt means velocity and d2X/dt2 means 
acceleration. g denotes a gravity acceleration constant. Here, 
g takes a positive value. 

[0144] 

A motional equation of the above dynamic model (an equation 

expressing a dynamic balance condition) is represented by 
equation 01, equation 02x, equation 02y, equation 03x, equation 
03y, £md equation 03z. 
[(3145] 

Fz=mb- (g+d2Zb/dt2 ) +msup^ ( g+d2 Zsup/dt2 ) 

+mswg^ (g+d2Zswg/dt2 ) Equation 01 

[0146] 

Fx-mb^d2Xb/dt2+msup*d2Xsup/dt2+mswg*d2Xswg/dt2 

Equation 02x 

[ 0147 ] 

Fy=mb^ d2Yb/dt2+msup*d2Ysup/dt2+mswg*d2Yswg/dt2 
Equation 02y 
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[0148] 

Mx=mb^ (Yb-Yzmp) ^ ( g+d2 Zb/dt2 ) 
-:nb* { Zb-Zzmp) * (d2Yb/dt2 ) 
+ Tisup* (Ysup-Yzmp) * ( g + d2Zsup/dt2 ) 
5 -msup^ (Zsup-Zzmp) * {d2Ysup/dt2) 

+ 'nswg^ (Yswg-Yzmp) ^ ( g+d2 Z swg/dt 2 ) 

-nsvjq^ (Zswg-Zzmp) ^ (d2Yswg/dt2) +J^d2ebx/dt2 

Equation 03x 

[0149] 

10 My--mb* (Xb-Xzmp) * (g+d2Zb/dt2) 
+mb* (Zb-Zzmp) * {d2Xb/dt2) 
-msup* (Xsup-Xzmp) * ( g+d2 Z sup /dt 2 ) 

+msup^ (Zsup-Zzmp) * (d2Xsup/dt2) 
-mswg^ (Xswg-Xzmp) * ( g+d2 Z swg/dt 2 ) 
1 5 +mswg* (Zswg-Zzmp) ^ (d2Xswg/dt2 ) +J^d2eby/dt2 

Equation 03y 

[ D150] 

Mz=mb^ (Xb-Xzmp) * (d2Yb/dt2) -mb* (Yb-Yzmp) ^ (d2Xb/dt2) 

+msup^ (Xsup-Xzmp) ^ (d2Ysup/dt2) 
20 -msup-^ (Ysup-Yzmp) ^ (d2Xsup/dt2) 

^mswg'^ (Xswg-Xzmp) ^ (d2Yswg/dt2) 

-mswg^ (Yswg-Yzmp) ^ (d2Xswg/dt2) 

+Jbz*d2ebz/dt2+Jaz*d20 az/dt2 

Equation 03z 

25 [0151] 

Furthermore, for a total center-of -gravi ty position of the 
robot, the following relational expressions hold: 
[0152 J 

ZGtotcil= (mb^Zb+msup*Zsup+mswg*Zswg) /mtotal 
30 Equation 04 
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[0153] 

XGtot al^ (inb^Xb+msup^Xsup+mswg^Xswg ) /mtotal 

Equation 05x 

[0154] 

YGtotal= (mb^Yb+msup*Ysup+mswg*Yswg) /mtotal 
Equation 05y 

[0155] 

The following will show a relationship between the above 
dynamic model and the above AFp, AMp, AFr, and AMr . 

[0156] 

Trie above AFp is a perturbation amount of Fx or Fy when 
d2Xb/dt2 or d2Yb/dt2 is perturbated by a unit amount in equation 

02x 02: equation 02y, so that it is determined according to the 
following equation: 
[0157 ] 

AFp = mb... Equation 0 6 
[ 0158 ] 

More specifically, the change AFp of a floor reaction force 

horizontal component per unit acceleration in the body 
translation mode corresponds to the mass of the body mass point 
3m of the dynamic model. 
[01591 

The above AMp is a perturbation amount of My or Mx when 
d2Xb/dt2 or d2Yb/dt2 is perturbated by a unit amount in equation 
03y or equation 03x, so that it is determined according to the 
following equation: 

[0160] 

AMp = mb* { Zb-Zzmp) ... Equation 07 

[0161] 

More specifically, the change AMp of a floor reaction force 
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moment horizontal component per unit acceleration in the body 
translation mode is obtained by multiplying a body mass point 
mass of the dynamic model by a height (vertical position) of the 
body mass point 3m from a desired ZMP , The relationship between 
5 the pc:)sitrons of the body mass point 3m and the desired ZMP and 
the motion of the body maiss point 3m corresponds to the behavior 
of an inverted pendulum obtained when the body mass point 3m is 
associated with an inverted pendulum mass point and when the 
desired ZMP is associated with an inverted pendulum supporting 
10 point. 

[0162 ] 

The above AFr is a perturbation amount of Fx or Fy when 

d20by/dt2 is perturbated by a unit amount in equation 02x or 
equation 02y, so that it is determined according to the following 
15 equation: 
[0163] 

AFr = 0... Equation 08 
[3164] 

Tnis means that the change AFr of a floor reaction force 
20 horizontal component per unit acceleration in the body 
inclination mode is zero. 
[0165] 

Tne above AMr is a perturbation amount of My when d29bx/dt2 
or d263by/dt2 is perturbated by a unit amount in equation 03x or 
25 equation 03y, so that it is determined according to the following 

equat ion : 

[ D 1 6 6 ] 

AMr = J... Equation 09 
[ 3167] 

30 More specifically, the change AMr of a floor reaction force 
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moment horizontal component per unit acceleration in the body 
inclination mode corrc^sponds to the inertial moments of 
horizontal axis flywheels ( FHx and Fhy) . 
[0168 ] 

The above AMbz is a perturbation amount of Mz when d29bz/dt2 
is perturbated by a unit, amount in equation 03z, so that it is 

deterjnined according to the following equation: 
[3169] 

AMbz = Jbz... Equation 09b 
[ 3170 ] 

More specifically/ the change AMbz of a floor reaction force 
moment, component per unit acceleration in the body yaw rotation 
mode corresponds to the inertial moment of a flywheel FHbz 

corresponding to body yaw rotation. 
[3171] 

Tne above AMaz is a perturbation amount of Mz when d20az/dt2 
is perturbated by a unit amount in equation 03z, so that it is 
determined according to the following equation: 

[ D172 ] 

AMaiz '-^ Jaz... Equation 0 9a 
[3173] 

More specifically, the change AMaz of a floor reaction force 
moment, component per unit angular acceleration of an antiphase 
arm swing corresponds to the inertial moment of a flywheel FHaz 
corresponding to an arm swing. 

[0174 i 

TJie gait generator 100 in the present embodiment generates 
a desired gait for one step in order, the desired gait (the desired 
gait in the narrow sense described above) for one step from the 
moment one leg 2 of the robot 1 lands to the moment the other 
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leg 2 lands. Hence, for the running gait shown in Fig. 2 to be 
generated in the present embodiment^ a desired gait from the 
beginning of a single stance period to the end of the following 
floating period (the beginning of the next single stance period) 
5 is generated in sequence. Here, a desired gait that is being 
newly generated will be referred to as a ^'current time gait,'' 
the next desired gait, will be referred to as a ^'next gait," and 
a desired gait after next will be referred to as a ""next but one 
time gait." Furthermore, a desired gait generated one step 
10 before the ^'current time gait" will be referred to as a ^'last 
time ' 3 gait . " 
[0175] 

When the gait generator 100 newly generates a current time 
gait, expected posi tions /pos tures of landing of the foot 22 of 

15 a free leg and required values (requests) of expected landing 
time lor the next two steps of the robot 1 are input as required 
parameters to the gait generator 100 (or the gait generator 100 
reads the required parameters from a memory) . Then, the gait 
generator 100 uses these required parameters to generate a 

20 desired body position/posture trajectory, a desired foot 
posit-L on/posture traj ectory, a desired ZMP traj ectory, a desired 
floor reaction force vertical component trajectory, a desired 
arm posture trajectory, etc. At this time, some of the gait 
parameters specifying these trajectories are corrected, as 

25 necessary, to secure continuity of walking. 
[0176] 

Taking the generation of the running gait shown in Fig. 2 
as an example, gait generation processing of the gait generator 
100 in the present embodiment will be explained in detail with 
30 referemce to Fig. 12 to Fig. 3-4. Fig, 12 is a flowchart 
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(structured flowchart) illustrating a main routine of the gait 
generation processing carried out by the gait generator 100. 
[0177] 

First, various initializing operations, including 
5 initialization of time t to zero, are performed in SOIO. This 
processing is implemented primarily when starting up the gait 
generator 100. Next, the processing proceeds to S014 via S012 
and waits for a timer interrupt for each control cycle (the 
calculation processing cycle of the flowchart shown in Fig. 12) . 
10 The control cycle is denoted by At. 
[ D178] 

Tnen, the processing proceeds to SG16 and determines whether 
a shift in a gait is taking place. If a shift in the gait is 
taking place, then the processing proceeds to S018, or if a shift 

15 in a gait is not taking place, then it proceeds to S030. Here, 
''the shift in a gait" means a timing at which the generation of 
the last time's gait has been completed and the generation of 
the current time gait is about to start. For instance, a control 
cycle following the control cycle in which the generation of a 

20 last time' s gait has been completed refers to the shift in a gait. 
[ 'J 1 7 9 1 

When proceeding to S018, time t is initialized to zero. The 
gait generator 100 then proceeds to S020 and reads a next time's 
gait supporting leg coordinate system, a next but one time' s gait 
25 supporting leg coordinate system, a current time gait cycle, and 
a next time gait cycle. These supporting leg coordinate systems 
and the gait cycles are determined by the above required 
parameters. More specifically, in the present embodiment, the 
requiired parameters supplied to the gait generator 100 from the 
joystj.ck 73 or the like include required values of expected 
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landing positions /postures (foot positions /postures in a state 
wherein the foot 22 has been rotated without slippage such that 
its sole is substantially in full contact with a floor surface 
after landing) and expected landing time of the foot 22 of a free 
5 leg for up to two steps ahead. The required value for the first 
step and the required value for the second step are supplied to 
the gait generator 100 as the values associated with a current 
time cjait and a next gait, respectively, before the generation 
of the current time gait is begun (the shift in a gait in S016 
10 mentioned above) . These required values can be changed in the 
middle of generating the current time gait. 
[0180] 

Tnen, the next time's gait supporting leg coordinate system 
is detiermined on the basis of the required value of the expected 
15 landing position/posture of the free leg foot 22 of the first 
step i the free leg foot 22 in the current time gait) in the above 
required parameters. 
[0181] 

Referring to, for example. Fig. 15, it is assumed that the 
20 required value for an expected landing position/posture of the 
free leg foot 22 (22L in the figure) related to the current time 
gait (first step) specifies a position/posture obtained by 
moving by xnext and ynext in the X-axis direction (in the 
longitudinal direction of a supporting leg foot 22R of the current 
25 time gait) and in the Y-axis direction (in the lateral direction 
of the supporting leg foot 22R of the current time gait), 
respectively, of a current time's gait supporting leg coordinate 
system, and by rotating about the Z-axis ( about the vertical axis ) 
by Gznext with respect to a landing position/posture of the 
30 supporting leg foot 22 (22R in the figure) of the current time 
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gait. Here, the supporting leg coordinate system is a global 
coordinate system (a coordinate system fixed to a floor) in which 
a point, at which a perpendicular line extended onto a floor 
surface from the center of the ankle of a supporting leg foot 
2 intersects with the floor surface (this point agreeing with 
a representative point of the foot 22 in a state, wherein 
substantially the entire surface of the sole of the supporting 
leg foot 22 is in contact with the floor surface in the present 
embodiment), in a state wherein the supporting leg foot 22 is 
set in a horizontal posture (more generally, a posture parallel 
to the floor surface) and substantially the entire surface of 
the sole of the supporting leg foot 22 is in contact (in close 
contact) with the floor surface, is defined as an origin thereof, 
and a horizontal plane passing the origin is defined as an XY 
plane. In this case, the X-axis direction and the Y-axis 
direction correspond to the longitudinal direction and the 
lateral direction, respectively, of the supporting leg foot 22. 
The origin of the supporting leg coordinate system does not have 
to agree with the representative point of the foot 22 (a point 
representing the position of the foot 22) in the state wherein 
substantially the entire surface of the sole of the supporting 
leg foot 22 is in contact with the floor surface. Alternatively, 
the oiigin may be set at a point on the floor surface that is 
different from the representative point . 
[0182] 

At. this time, the next time's gait supporting leg coordinate 
system is a coordinate system that takes, as its origin, the 
representative point (more specifically, a point on a floor that 
agrees with the representative point) of the foot 22L in a case 
where the foot 22 is landed according to a required value of the 
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expected landing position/posture of the free leg foot 22L of 
the current time gait as illustrated (in a case where the 
representative point of the foot 22 is made to agree with the 
required value of an expected landing position and the posture 
5 (orientation) of the foot 22 is made to agree with the required 
value of an expected landing posture), the longitudinal 
direction and the lateral direction of the foot 22L in the 
horizontal plane passing the origin corresponding to an X' -axis 
direction and Y' -axis direction, respectively. 
10 [0183] 

In the same manner described above, a next but one time's 
gait supporting leg coordinate system (refer to the X" Y" 
coordinates shown in Fig. 15) is determined on the basis of the 
required values for the expected landing position/posture of the 
15 free leg foot 22 of the second step. A current time gait cycle 
is determined as the duration from the expected landing time 
(required value) of the supporting leg foot 22 of the current 
time gait to the expected landing time (required value) of the 
free leg foot 22 of the first step (current time gait) . The next 
20 time qait cycle is determined as the duration from the expected 
landing time (required value) of the free leg foot 22 of the first 
step t:o the expected landing time (required value) of the free 
leg foot 22 of the second step. 

[ 0 1 8 4 J 

25 The required parameters are input to the gait generator ICQ 

by necessary manipulation of the joystick 44 in the present 
embod:,ment. Alternatively, however, the requi red par ame ter s or 
the positions/postures and gait cycles of the aforesaid 
supporting leg coordinate systems associated with the required 

30 param€3ters may be stored in advance as a travel schedule of the 
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robot 1 . Alternatively, the aforesaid next time and the next 
but one time' s gait supporting leg coordinate systems and the 
current time and the next time gait cycles may be determined on 
the basis of commands (requests) from a control device, such as 
rhe joystick 44, and a travel history of the robot 1 up to that 
moment . 

[0185] 

Subsequently, the processing proceeds to S022 and determines 
gait parameters of a normal turning gait as a virtual cyclic gait 
that follows the current time gait. The gait parameters include 
a foot trajectory parameter defining a desired foot 
position/posture trajectory, a reference body posture 
trajectory parameter defining a body posture trajectory to be 
based on, a reference arm posture trajectory parameter defining 
an am posture trajectory to be based on, a ZMP trajectory 
parameter defining a desired ZMP trajectory, and a floor reaction 
force vertical component trajectory parameter defining a desired 
floor reaction force vertical component trajectory in the normal 
turning gait. Furthermore, parameters that define a floor 
reaction force horizontal component permissible range and a 
floor reaction force moment vertical component permissible range 
are also included in gait parameters. 

[G186] 

In the present description, "the normal turning gait" is used 
to mean a cyclic gait that does not cause discontinuity in 
motional states (states of foot position/posture, body 
position/posture, etc. ) of the robot 1 in a boundary of gait when 
the gait is repeated (the boundary of a gait for each step in 
the present embodiment) . Hereinafter, "the normal turning gait" 
may be abbreviated as "the normal gait.'' 
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[018 7 1 

A<rcording to the present embodiment, the normal turning gait, 
which is a cyclic gait, may be defined as follows. A gait for 
two steps of the robot 1, i.e., a gait composed of a first turning 
5 gait following a current time gait and a second turning gait 
following the first turning gait, as the gait for one cycle. The 
normal turning gait consists of a repetition of the gait for one 
cycle. The term '^turning'' is used here, because it would mean 
straight advancement when the turning rate is set to zero, and 

10 straight advancement can be also included in turning in a broad 
sense. If a desired gait to be generated is the running gait 
shown in Fig. 2, then a current time gait of the desired gait 
is a running gait that has a single stance period and a floating 
period. hence, the first turning gait and the second turning 

15 gait of the normal turning gait are both gaits that also have 
a single stance period and a floating period, as in the current 
time gait. In other words, a basic gait form of the first turning 
gait and the second turning gait is the same as the current time 
gait . 

20 [0188] 

Supplemental explanation of the normal turning gait will be 
added. In a bipedal mobile robot, the normal turning gait for 
one cycle requires the gaits in the aforesaid narrow sense for 
at least two steps. It is further possible to set a complicated 

25 normal turning gait using a gait for three steps or more as the 
gait for one cycle. The normal turning gait, however, is used 
only to determine a divergent component (to be discussed in detail 
hereinafter) at the end (finish time) of the current time gait. 
For this reason, using the normal turning gait composed of a gait 

30 for three or more steps for one cycle will provide low effect 
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despite the complicated processing for generating the gait. 
Therelore, the gait for one cycle in the normal turning gait in 
the present embodiment is composed of a gait for two steps (the 
first and the second turning gaits) . For a legged mobile robot 
5 having three or more feet, the number of gaits for defining the 
norma] turning gait will increase accordingly. In the following 
description, for the convenience of explanation, the normal 
turning gait composed of a plurality of gaits in the narrow sense 
(the gait for two steps in the present embodiment) will be 
10 regarded as the gait for one step. 
[0189] 

A normal turning gait is prepared, by the gait generator 100, 
for piovisional use to determine motional states of the robot 
1, including a divergent component at the end of a current time 
15 gait or a vertical body position velocity, a body posture angle, 
and an angular velocity thereof, and it is not directly output 
from the gait generator 100. 
[(31901 

The term ''divergent" means that the position of the body 3 
20 of the bipedal mobile robot 1 is undesirably shifted to a position 
away f rom the positions of both feet 22 and 22, as shown in Fig. 
i3. The value of a divergent component is a numeral value 
indicating how far the position of the body 3 of the bipedal mobile 
robot 1 is away from the positions of both feet 22 and 22 (to 
25 be more specific, the origin of a global coordinate system (a 
supporting leg coordinate system) set on the surface with which 
a supporting leg foot 22 is in contact) . 
[ 0191 1 

In the present embodiment, gaits are generated using a 
30 divergent component as an indicator so that a desired gait can 
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be continuously generated without causing the divergence. 
However, even if it is an initial divergent component (divergent 
component at initial time of the normal turning gait) of the 
normal gait, which is a typical example of a continuous gait (a 
cyclic gait that permits repetition of a gait of the same pattern 
without causing discontinuity of a gait trajectory, and that does 
not rheoretically diverge after an infinite number of 
repetitions) , the initial divergent component is not simply zero. 
The initial divergent component changes if a parameter of a normal 
gait changes. In other words, a proper divergent component 
changes according to a gait form, such as the manner of walking 
or the manner of running, or the like . In the present embodiment, 
therefore, a normal gait following a current time gait to be 
generated is set on the basis of required parameters involved 
in the current time gait, and the initial divergent component 
of the normal gait is determined, and then a current time gait 
is generated such that the divergent component at the end of the 
current time gait agrees with the initial divergent component 
of the normal gait (more generally, the current time gait is made 
to continue or approximate to the normal gait) . The basic 
guideline for generating such gaits is the same as that disclosed 
in Japanese Patent Application No. 2000-352011 previously 
proposed by the present applicant. 
[0192] 

The embodiment of the present invention does not use a linear 
dynamic model with three mass points used in the first embodiment 
of Japanese Patent Application No. 2000-352011. Nevertheless, 
the concept of the divergent component and a convergent component 
defined by the equation given below can be applied with adequate 
approximate accuracy to a perturbation of a behavior of a 
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nonlinear dynamic model such as the one shown in Fig. 10. 
[C193] 

Divergent component = Body mass point horizontal position 

-t- Body mass point horizontal velocity / coO 

... Equation 10 
[0194 ] 

Convergent component = Body mass point horizontal position 
- Body mass point horizontal velocity / uO' 
... Equation 11 
[0195] 

where the body mass point horizontal position in this case 
indicates a body mass point horizontal position Xb in the dynamic 
model shown in Fig. 10. 

[3196! 

0)0 and 030' take predetermined values. The values of these 
030 and (jO' are substantially the same, although they do not 
exactly coincide. Further, the values for generating walking 
gaits m Japanese Patent Application No. 2000-352011 must be 
slightly changed for running. 

[0197] 

More details of the divergent component and the convergent 
component have been given in Japanese Patent Application No. 
2000-352011, so that no more description will be given here. 

[0198] 

In the present embodiment, in addition to the method 
disclosed in Japanese Patent Application No. 2000-352011, a gait 
parameter defining a desired floor reaction force vertical 
component trajectory is set, and a total center-of -gravity 
vertical position of the robot 1 is determined so as to 
dynamically satisfy the desired floor reaction force vertical 
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component, as will be discussed hereinafter. In this case, a 
second order integrated value of the floor reaction force 
vertical component will define the total center-of -gravity 
vertical position of the robot 1. Hence, if the desired floor 
5 react.Lon force vertical component is improperly set, then the 
total cent er-of -gravity vertical position or the vertical body 
position of the robot 1 will be too high or too low. Therefore, 
the me^thod for setting a desired floor reaction force vertical 
component is also an important issue. However, the relationship 

10 between a floor reaction force vertical component and a vertical 
body 5)Osition is similar to the relationship between ZMP and a 
horizontal body position, so that a part of a technique for 
determining a desired ZMP for setting a proper horizontal body 
position velocity can be applied to a technique for determining 

15 a desxred floor reaction force vertical component for setting 
a proper vertical body position velocity simply by slightly 
changing a part thereof, as shown in the following present 
embodiment . 
[ (3 1 9 9 i 

20 Returning to the main subject, in S022, the processing below 

is carried out according to the flowchart shown in Fig. 14. 
[(3200] 

First, in SlOO, a foot trajectory parameter among the gait 
parameters of a normal gait is determined to provide a foot 

25 position/posture trajectory composed of a current time gait, a 
first turning gait, and a second turning gait in succession in 
this order . The following will explain a specific setting method 
with i^efeience to Fig. 15. In the following explanation, the 
foot 22 of a supporting leg 2 will be referred to as the supporting 

30 leg foot and the foot 22 of a free leg 2 will be referred to as 
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^he fiee leg foot. Further, ''start'' and ''end" will mean start 
time and end time of a gait or instantaneous gaits at the start 
nime cind the end time. 
[0201] 

5 The foot trajectory parameter is constructed primarily of 

the posit ions /postures of the supporting leg foot and the free 
leg foot, respectively, at the start and the end, respectively, 
of a f irst turning gait and a second turning gait, and a gait 
cycle of each turning gait. In the foot trajectory parameter, 

10 the free leg foot position/posture at the start of the first 
turning gait is defined as the supporting leg foot 
position/posture at the end of a current time gait observed from 
a next, time's gait supporting leg coordinate system. In this 
case, the supporting leg foot 22 at the end of the current time 

15 gait is moving in the air in a running gait. And the supporting 
leg foot position/posture at the end of the current time gait 
is determined by generating a required value of an expected 
landing position/posture of the free leg foot 22 of a second step 
in the required parameter (a required value of an expected landing 

20 posi tjon/posture in a next time gait of the supporting leg foot 
22 of the current time gait) or a foot position/posture trajectory 
for reaching a free leg position/posture at the end of the next 
time gait determined on the basis of a next but one time's gait 
supporting leg coordinate system that corresponds to the above 

25 requi2:ed value (more specifically, the trajectory observed from 
a next, time's gait supporting leg coordinate system) from the 
suppoi'ting leg foot position/posture at the start of the current 
time gait (= the free leg foot position/posture at the end of 
the last time' s gait) by using the finite-duration setting filter 

30 until the end of the current time gait. 
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[02 02 1 

The free leg foot position/posture at the end of the next 
time qait is determined such that the position/posture of the 
foot obtained when the foot 22 is turned from that 

5 position/posture by a predetermined angle in the pitch direction 
until it reaches a horizontal posture by lowering its tiptoe while 
holding the foot 22 in contact with the ground agrees with the 
position/posture in the next but one time's gait supporting leg 
coordinate system. In other words, the free leg foot 

10 position/posture at the end of the next time gait is the 
position/posture of the foot 22 in a state wherein the foot 22 
has been turned, from a required value of the landing 
position/posture of the free leg foot 22 of the second step in 
the required parameter, by a predetermined angle in the pitch 

15 direction by lifting its tiptoe while holding the foot 22 in 
contact with the ground so that it does not slip (a state wherein 
the heel has been landed with the tiptoe lifted) . 
[0203] 

Further, the supporting leg foot position/posture at the 
20 start of the first turning gait is defined as the free leg foot 
position/posture at the end of the current time gait observed 
from the next time's gait supporting leg coordinate system. In 
this case, the free leg foot position/posture at the end of the 
current time gait is determined on the basis of the above next 
25 time' s gait supporting leg coordinate system or a required value 
of an expected landing position/posture of the free leg of the 
first, step (the current time gait) of the required parameter 
corresponding thereto, as in the case of the free leg foot 
position/posture at the end of the next time gait. In other words, 
30 the free leg foot position/posture at the end of the current time 

- 110- 



gait is determined such that a representative point of the foot 
obtained when substantially entire surface of the sole of the 
foot 22 is brought into contact with a floor surface by turning 
the foot 22 from the position/posture so as to lower its tiptoe 
5 while holding the foot 22 in contact with the ground agrees with 
the origin of the next time's gait supporting leg coordinate 
sy s tern . 

[ 3204 ] 

Tne free leg foot position/posture at the end of the first 

10 turning gait is determined on the basis of a position/posture 
on the^ next but one time's gait supporting leg coordinate system 
observed from the next time's gait supporting leg coordinate 
system, as in the case of the technique for determining the free 
leg foot position/posture at the end of the current time gait 

15 or th€? free leg foot position/posture at the end of the next time 
gait. To be more specific, the free leg foot position/posture 
at the end of the first turning gait is determined such that the 
position/posture of the foot obtained when the foot 22 is turned 
from that position/posture by a predetermined angle until it 

20 reaches a horizontal posture while avoiding a slippage and while 
holding the foot 22 in contact with the ground agrees with the 
position/posture in the next but one time's gait supporting leg 
coordinate system as observed from the next time's gait 
supporting leg coordinate system. 

25 [0205] 

At the end of the first turning gait, the supporting leg foot 
22 if; in the air, being off the floor. To determine the 
trajectory after the supporting leg foot 22 leaves the floor, 
an expected landing position/posture of the supporting leg foot 
30 of the first turning gait is set. The expected landing 



position/posture of the supporting leg foot of the first turning 
gait :.s set on the basis of a position/posture on a next but two 
time' 3 gait supporting leg coordinate system observed from the 
next -rime's gait supporting leg coordinate system. To be more 
specific, the expected landing position/posture of the 
supporting leg foot of the first turning gait is the 
position/posture on the next but two time's gait supporting leg 
coordinate system observed from the next time's gait supporting 
leg coordinate system. The next but two time's gait supporting 
leg coordinate system is set such that the relative 
position/posture relationship between the next but one time's 
gait ^supporting leg coordinate system and the next but two time' s 
gait supporting leg coordinate system agrees with the relative 
position/posture relationship between the current time's gait 
supporting leg coordinate system and the next time's gait 
supporting leg coordinate system. 
[ 0206] 

The supporting leg foot position/posture at the end of the 
first turning gait is determined by generating a foot 
position/posture trajectory for reaching the expected landing 
position/posture of the supporting leg foot of the first turning 
gait from the supporting leg foot position/posture at the start 
of the first turning gait (more specifically, the trajectory 
observed from a next time's gait supporting leg coordinate 
system) by using the finite-duration setting filter until the 
end of the first turning gait, as in the case where the supporting 
leg foot position/posture at the start of the first turning gait 
is determined. 
[0207] 

The free leg foot position/posture at the start of the second 
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turning gait is regarded as the supporting leg foot 
positLon/posture at the end of the first turning gait observed 
from the next but one time' s gait supporting leg coordinate system. 
The supporting leg foot position/posture at the start of the 
second turning gait is regarded as the free leg foot 
positLon/posture at the end of the first turning gait observed 
from the next but one time's gait supporting leg coordinate 
system . 

[0208] 

The free leg foot position/posture at the end of the second 
turning gait is regarded as the free leg foot position/posture 
at the end of the current time gait observed from the current 
time's gait supporting leg coordinate system. The supporting 
leg foot position/posture at the end of the second turning gait 
is regarded as the supporting leg foot position/posture at the 
end of the current time gait observed from the current time's 
gait supporting leg coordinate system. 
[0209] 

The gait cycles of the first turning gait and the second 
turning gait are set to be identical to a next time gait cycle. 
These gait cycles of the first turning gait and the second turning 
gait do not have to be the same with each other; however, both 
cycles are preferably determined on the basis of at least a next 
time gait cycle . Motion parameters (including a time parameter, 
such as double stance period duration) of the current time gait, 
the first turning gait, and the second turning gait other than 
the above described motion parameters are determined, as 
necessary, to satisfy gait conditions (such as an actuator 
velocity falling within a permissible range, a movable angle 
being not exceeded, and no interference with a floor) on the basis 
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of the parameters determined above. 
[ 3210] 

Next, the processing proceeds to S102 and determines a 
reference body posture trajectory parameter that defines the 

5 reference body posture trajectory to be followed by a desired 
body Gesture. The reference body posture does not have to be 
constant as long as it is set to ensure connection at the start 
(the start of the first turning gait) and the end (the end of 
the second turning gait) of a normal gait (to ensure that the 

10 posture angle of the reference body posture and the angular 
velocity thereof at the start of a normal gait agrees with those 
at the end of the normal gait) . In the present embodiment, 
however, for the purpose of easy understanding, the reference 
body posture is set to an upright posture (vertical posture) . 

15 This means that, in the present embodiment, the reference body 
posture is set to the upright posture in all periods of the normal 
gait. Accordingly, in the present embodiment, the angular 
velocity and angular acceleration of a posture angle of the 
reference body posture are zero. A yaw angle trajectory 

20 (hereinafter referred to also as a reference yaw angle 
trajectory) ebz of the re ference body posture may be , for example, 
a mot.ion at a constant angular velocity (an average turning 
velocity of a normal gait) , or may take a sinusoidal wave shape, 
as in the example (Fig. 51) of a reference antiphase arm swing 

25 trajectory, which will be discussed hereinafter. However, the 
yaw angle trajectory is to be set such that a reference yaw angle 
and its angular velocity are in succession when the normal gait 
is repeated. 
^:0211] 

30 ::n the present embodiment, the yaw angle trajectory 
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( hereinaf ter referred to also as a desired yaw angle trajectory) 
of a desired body posture is set to agree with a reference yaw 
angle trajectory. 
[0212 1 

5 Subsequently, the processing proceeds to S104 to determine 

reference arm posture trajectory parameters. To be more 
specific, parameters related to a total center-of -gravity 
position of both arms, a lateral interval between right and left 
hands, and an antiphase arm swing angle are determined. For 

10 turning, for example, to the left as shown in Fig. 28, the 
reference antiphase arm swing angle may be set as shown in Fig. 
51. As illustrated in Fig. 51, a reference antiphase arm swing 
angle Gazref is set such that, when a normal gait is repeated, 
an antiphase arm swing angle and an angular velocity will be both 

15 contii^LUous at a boundary of gaits (the boundary between the end 
of a second turning gait and the next first turning gait) and 
the relative relationship between the supporting leg at the start 
of the first turning gait and an antiphase arm swing angle agrees 
with the relative relationship between the supporting leg at the 

20 start of the next first turning gait and an antiphase arm swing 
angle. In other words, the antiphase arm swing angular velocity 
at the start of the first turning gait and the antiphase arm swing 
angular velocity at the end of the second turning gait agree with 
each other, and the antiphase arm swing angle at the end of the 

25 second turning gait is set to a value obtained by adding the 
antipliase arm swing angle at the start of the first turning gait 
to the turning angle of the normal gait (the sum of the turning 
angles of the first turning gait and the second turning gait) . 
In Fig. 51, the reference antiphase arm swing angle 9azref has 

30 the s:.nusoidal waveform; however, it may alternatively be set 
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to a constant angular velocity, or it may take an average value 
of a ^supporting leg yaw angle and a free leg yaw angle. 
[0213] 

In the present embodiment, the total center-of -gravity 
5 position of both arms the desired arm posture is set to be 
maint.ained constant with respect to the body. 
[3214] 

Next, the processing proceeds to S106 and sets a floor 
reaction force vertical component trajectory parameter . In this 

10 case, the floor reaction force vertical component trajectory 
parameter is set such that the floor reaction force vertical 
component trajectory defined by the parameter is virtually 
continuous (values do not jump in steps), as shown in Fig. 3, 
in bo-h the first turning gait and the second turning gait. In 

15 other words, a desired floor reaction force vertical component 
trajectory of the normal turning gait is set to have the pattern 
shown in P'^ig. 16. According to the pattern, for both the first 
turning gait and the second turning gait, the floor reaction force 
vertical component exhibits a trapezoidal change in a single 

20 stance period, and the floor reaction force vertical component 
is maintained at zero in a floating period. The time of break 
points of the pattern and the height of a trapezoid (peak value) 
are set as the floor reaction force vertical component trajectory 
parameters . 

25 [0215] 

When setting the floor reaction force vertical component 
trajectory parameters, an average value throughout a gait period 
of the floor reaction force vertical component (the period 
equivalent to the sum of the periods of the first turning gait 
30 and the second turning gait, or the period equivalent to one cycle 
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of a r^ormal gait) is made to agree with the self weight of the 
robot 1. This means that the average value of the floor reaction 
force vertical component is set so that it provides the same 
magnii:.ude as that of the gravity acting on the robot 1 but in 
an opposite direction. 
[0216] 

Setting the floor reaction force vertical component 
trajec:tory as described above is necessary to satisfy a normal 
gait condition. The normal gait conditions is such that a 
beginning state (a beginning state of a first turning gait) of 
any state variables (a position, a posture, a velocity or the 
like of each part of the robot 1) of a gait observed from a 
suppoiting leg coordinate system (a coordinate system set on a 
plane with which the supporting leg foot 22 is in contact) and 
a terminal state (a terminal state of a second turning gait) of 
a gait observed from the next supporting leg coordinate system 
(the supporting leg coordinate system of the next first turning 
gait) agree with each other (hereinafter, this condition may be 
referred to as a boundary condition of a normal gait) . Therefore, 
the difference between a total center-of -gravi t y vertical 
velocity of the robot 1 at the end of the normal gait and a total 
center-of -gravity vertical velocity at the start of the normal 
gait more specifically, the difference between the total 
center-of-gravity vertical velocity at the end of a second 
turning gait and the total center-of-gravity vertical velocity 
at the start of the first turning gait) must be also zero. The 
difference is an integrated value of the difference between the 
floor leaction force vertical component and gravity (first order 
integrated value) ; therefore, the floor reaction force vertical 
component trajectory must be set as described above in order to 
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set tae difference to zero. 
[ D217 1 

Ii the present embodiment, the average value of the floor 
reaction force vertical component in the period of each of the 
first turning gait and the second turning gait has been made to 
agree with the self weight of the robot 1. More specifically, 
based on, for example, the gait cycle of the first turning gait 
and the second turning g£iit, the time of the break points of the 
trapezoidal portions of the floor reaction force vertical 
component trajectory in each turning gait has been set, and then 
the heights of the trapezoidal portions have been determined such 
that ^"he average value of the floor reaction force vertical 
component in the period of each of the first turning gait and 
the second turning gait agrees with the self weight of the robot 
1 (th€e heights of the trapezoids are determined by solving an 
equation representing the condition under which the average 
value and the self weight coincide, taking the heights of the 
trape2'.oids as unknown numbers) . 

[0218] 

Thus, the difference between the total center-of -gravi ty 
vertic:al velocity at the end of the first turning gait and the 
total center-of -gravity vertical velocity at the start of the 
first turning gait will be zero, and the difference between the 
total center-of -gravity vertical velocity at the end of the 
secono turning gait and the total center-of -gravi ty vertical 
velocity at the start of the second turning gait will be also 
zero. This, however, is not a must. If, for instance, a vertical 
body position becomes excessively high or low at about a boundary 
of the first turning gait and the second turning gait, leading 
to a Irkelihood of an unreasonable posture, then the heights or 
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the like of trapezoids of the floor reaction force vertical 
component trajectory of each turning gait may be corrected in 
the state in which the average value and the self weight agree 
in each turning gait. 
5 [3219] 

Next, the processing proceeds to S108 to set a permissible 
range of a floor reaction force horizontal component [Fxmin, 
Fxmax] (more specifically, a parameter defining it), as shown 
in Fig. 17, on the basis of the floor reaction force vertical 

10 component trajectory set as shown in Fig. 16, as described above. 
The polygonal line on the negative side in Fig. 17 indicates the 
permissible lower limit value Fxmin of the floor reaction force 
horizontal component, while the polygonal line on the positive 
side indicates the permissible upper limit value Fxmax of the 

15 floor reaction force horizontal component. A supplemental 
description will be given of a method for setting them. The 
following will explain a case where a floor surface is horizontal . 
[0220] 

Ihe floor reaction force horizontal component is generated 
20 from friction between a floor and a foot 22 . The friction cannot 
be generated limitlessly; it has a limit. Hence, the floor 
reaction force horizontal component of a desired gait has to be 
always within a friction limit in order to prevent the robot 1 
from slipping when the actual robot 1 moves according to a 
25 generated desired gait. To meet this condition, a permissible 
range of the floor reaction force horizontal component will be 
set, and a desired gait will be generated such that the floor 
reaction force horizontal component of the desired gait falls 
within the permissible range, as it will be discussed 
30 hereinafter. 
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[ 0 2 2 1 i 

When t,he coefficient of friction between the floor and the 
foot 22 is denoted by Fxmin must be always set to be not less 
than -|j floor reaction force vertical component, and Fxmax must 
5 be set to be not more than \i * floor reaction force vertical 
component. A simplest setting method is to set according to the 
following expression, in which ka is a positive constant that 
is smellier than 1. 
[0222] 

10 Fxmin =^ ~ka * y ^ Floor reaction force vertical component 
Fxmax = k£i p "^^^ Floor reaction force vertical component 
... Equation 12 

[ 0223 J 

The permissible range of the floor reaction force horizontal 
15 component shown in Fig. 17 is an example set according to Equation 
12. The values and time at the break points of the trapezoidal 
waveforms or the like in Fig. 17 may be set as the parameters 
for defining the permissible range of the floor reaction force 
horizontal component. Alternatively, however, if the 

20 permi^^sible range of the floor reaction force horizontal 
component is determined according to Equation 12, then the value 
of (k^i^ij) in Equation 12 may be simply set as a parameter. 
[0224] 

As long as the above condition (the condition in that the 
25 floor reaction force horizontal component of a desired gait 
always; falls within a frictional limit) is satisfied, a different 

setting method may be used to set the permissible range of the 
floor reaction force horizontal component. 
[0225] 

30 Tlrie gait generator 100 then proceeds to S109 and sets the 
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permissible range of a floor reaction force moment vertical 
component [Mzmin, Mzmax] (more specifically, a parameter 
defin:_ng it), as shown in Fig. 41, on the basis of the floor 
reaction force vertical component trajectory or the like set as 
5 shown in Fig. 16, as described above. The polygonal line on the 
negat:.ve side in Fig. 41 indicates the permissible lower limit 
value Mzmin of the floor reaction force moment vertical component, 
while the polygonal line on the positive side indicates the 
permissible upper limit value Mzmax of the floor reaction force 
10 moment vertical component. A supplemental description will be 
given of a method for setting them. The following will explain 
a case where a floor surface is horizontal. 
[0226] 

The floor reaction force moment vertical component is 
15 generated from friction between a floor and a foot 22. The 
friction cannot be generated limitlessly; it has a limit. Hence, 
the floor reaction force moment vertical component of a desired 
gait has to be always within a friction limit in order to prevent 
the robot 1 from slipping when the actual robot 1 moves according 
20 to a generated desired gait. To meet this condition, a 
permissible range of the floor reaction force moment vertical 
comporLent will be set, and a desired gait will be generated such 
that the floor reaction force moment vertical component of the 
desire^d gait falls within the permissible range, as it will be 
25 discussed hereinafter. 
[0227] 

If the coefficient of friction between the floor and the foot 
22 is denoted by p, and an effective radius of the surface of 
contact between the floor and the foot 22 to generate a moment 
30 vertical component (or a square root of a sectional secondary 
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moment: about a desired ZMP of the surface of contact between the 
floor and the foot 22) is denote by r, then Mzmin must be always 
set to be not less than -y ^ r * floor reaction force vertical 
component, and Mzmax must be set to be not more than jj r * floor 
5 reaction force vertical component. A simplest setting method 
:ls to set according to the following expression, in which ka is 
a positive constant that is smaller than 1. 
[0228] 

Mzxmin = -ka * |a * r ^ Floor reaction force vertical component 
10 Mzmax = ka ^ y * r * Floor reaction force vertical component 
... Equation 1012 
[0229] 

The permissible range of the floor reaction force moment 
vertic:al component shown in Fig. 41 is an example set according 

15 to Equation 1012. The values and time at the break points of 
the trapezoidal waveforms or the like in Fig. 41 may be set as 
the parameters for defining the permissible range of the floor 
^reaction force moment vertical component. Alternatively, 
howev€^r, if the permissible range of the floor reaction force 

20 moment vertical component is determined according to Equation 
1012, then the value of (ka^p) in Equation 1012 may be simply 
set as a parameter. r is desirably calculated from a desired 
ZMP and a contact surface at each instant; alternately, however, 
r may be a constant. 

25 [0230] 

As long as the above condition (the condition in that the 
floor reaction force moment vertical component of a desired gait 
always falls within a f rictional limit) is satisfied, a different 
setting method may be used to set the permissible range of the 
.>0 floor reaction force moment vertical component. 
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[1)2 31 J 

Furthesr alternatively, a permissible range may be set by 
combining a floor reaction force horizontal component and a floor 
react:.on force vertical component moment rather than setting the 
5 permissible range of a floor reaction force horizontal component 
and the permissible range of a floor reaction force moment 
vertic:al component independently. This is because the 

permis^sible range of a floor reaction force moment vertical 
component becomes narrower as a floor reaction force horizontal 
10 component increases, while the permissible range of the floor 
2:eactj.on force horizontal component becomes narrower as the 
floor reaction force moment vertical component increases. 
[0232] 

Ne^xt, the processing proceeds to SllO and sets ZMP trajectory 
15 parameters defining the ZMP trajectory of the normal gait that 
combines the first turning gait and the second turning gait. In 
this case, a desired ZMP trajectory is set so as to exhibit a 
high stability margin and no sudden changes, as described above. 
[0233] 

20 Tc> be more specific, according to the running gait shown in 

Fig. 2, a few moments after the heel of the supporting leg foot 
22 lands, substantially the entire surface of the sole of the 
supporting leg foot 22 comes in contact with the ground, and then, 
following a few moments, only the tiptoe of the supporting leg 

25 foot 22 comes in contact with the ground. Thereafter, the robot 
1 kicks the ground with the tiptoe of the supporting leg foot 
22 to jump into the air. Lastly, the robot 1 lands at the heel 
cf the free leg foot 22. The desired ZMP has to be in a ground 
contact surface. In the present embodiment, therefore, the 

30 position of the de sired ZMP in the X— axis direction for the first 



- 123 - 



curning gait and the second turning gait of the normal gait is 
set so that it takes the heel of the supporting leg foot 22 as 
its initial position and stays at this position until 
subs tanticilly the entire sole of the foot 22 comes in contact 
5 with t.he ground, as illustrated in the upper diagram of Fig. 4 
described above. Subsequently, the desired ZMP is set to move 
"o th€3 center of the supporting leg foot 22, and then move to 
che tiptoe by the time the tiptoe of the foot 22 comes in contact 
with t-he ground and remain at the tiptoe of the supporting leg 

10 foot 22 until the foot 22 leaves the floor. Thereafter, the 
desire^d ZMP is set such that the desired ZMP continuously moves 
from the tiptoe of the supporting leg foot 22 to the landing 
posit:_on of the heel of the free leg foot 22 by the time the next 
free leg foot 22 lands, as previously described. Thus, the 

15 desired ZMP trajectory (the trajectory in the X-axis direction) 
of the normal gait composed of the first turning gait and the 
second turning gait will be as illustrated in Fig. 18. The time 
and positions of the break points of the desired ZMP trajectory 
are set as the ZMP trajectory parameters. In this case, the time 

20 of the- break points is set on the basis of gait cycles of the 
first turning gait and the second turning gait determined based 
on the required parameters . The positions of the break points 
are set on the basis of the posit ions /postures on the next time's 
gait supporting leg coordinate system and the next but one time' s 

25 gait supporting leg coordinate system or on the basis of the 
requiied values of the expected free leg foot landing 
positions/postures of the first step and the second step of the 
irequired parameters that define these coordinate systems. The 
position of the ZMP trajectory in the Y-axis direction is set 

30 in the same manner as that illustrated in the lower diagram of 
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Fig. 4. More specifically, the trajectory of the positions of 
the desired ZMP in the Y-axis direction in the first turning gait 
is set according to the same pattern as that shown in the lower 
diagram of Fig. 4. The trajectory of the positions of the desired 
5 ZMP in the Y-axis direction in the second turning gait is set 
to have the same shape cis that for the first turning gait and 
continues from the end of the trajectory. 
[0234.1 

Subsequently, the processing proceeds to S112 and redefines 
10 the start time, the end time, and duration of one step (one cycle) 
of the normal gait as follows. 

[0235] 

A normal gait must be a gait in which state variables 
continuously connect at the start and the end thereof. To easily 

15 determine such a gait, in the present embodiment, the start, the 
end, and the duration of one step of a normal gait are determined 
as illustrated in Fig. 16 for convenience sake, which is different 
from the definition of a gait in the narrow sense described above. 
Specifically, in the latter half of a single stance period of 

20 the first turning gait, the time at which the floor reaction force 
vertical component has reduced to a certain degree is set as start 
cime Is of the normal gait. The start time Ts is preferably set 
ro the time of the moment at which the state wherein substantially 
the entire surface of the sole of the supporting leg foot 22 is 

25 in contact with the ground is switched to tiptoe contact with 
the ground or at the time immediately preceding it, as shown in 
Fig. (the time when the period of the entire sole surface in 
contac:t with the ground ends or the time immediately preceding 
it, as shown in Fig. 4) . A description will now be given of the 

30 relationship between the desired ZMP and time Ts shown in Fig. 
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18 (or F'ig. 4) set in 3110. After substantially the entire 
surface of the sole of the supporting leg foot 22 comes in contact 
with the ground in the first turning gait, the desired ZMP moves 
to the center of the supporting leg foot 22 . The instant the 
5 movement t.o the tiptoe is completed by the tiptoe contact with 
the ground is established is preferably time Ts . The start time 
Ts is set. on the basis of, for example, the desired ZMP trajectory 
parameters previously set. The reason for setting the start time 
Ts as described above will be discussed hereinafter. 
10 [0236J 

As shown in Fig. 16, a cycle Tcyc of the normal gait is a 
sum of the gait cycles of the first turning gait and the second 
turning gait. The end time of the normal gait is denoted by Te . 
Te is set to the time obtained by adding Tcyc to Ts . 
15 [02 37.1 

The definition of the start, the end, or the like of a gait 
will be returned to the definition of the gait in the aforesaid 
narrow sense again from the moment the normal gait is determined 
(the moment the program leaves the loop of S204 shown in Fig. 

20 19) . In the following explanation, the start time (the time at 
which the supporting leg foot 22 lands first) according to the 
definj.tion of a gait based on the aforesaid narrow sense will 
be set. to 0, and the above start time Ts used until the normal 
gait is determined will be distinguished from the original start 

25 time C' by using the reference mark Ts (abbreviated to ^''Ts" in 
some c:ases ) . 
[ 0238 ] 

Lcistly, the processing proceeds to S114 and sets a body 
postuie angle and antiphase arm swing angle restoring period [Tm, 
.30 Ts2] and [Tm2, Te] of the normal gait. Supplementally, when the 
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normal gait is repeated, the body posture angle and the antiphase 
arm swing angle should be continuous in a boundary of gaits. For 
this jmrpose, the beginning body posture angular velocity and 
the ending body posture angular velocity of the normal gait must 
5 agree with each other, and the beginning antiphase arm swing 
angul^ir velocity and the ending antiphase arm swing angular 
veloc:^-ty must agree with each other. The aforesaid period is 
the period for adjusting a body posture angle trajectory and an 
antiphase arm swing angle trajectory to implement the agreement. 
10 The period for restoring (adjusting) the body posture angle and 
the period for restoring (adjusting) the antiphase arm swing 
angle may be set separately. 
[02 39] 

To be more specific, the gait goes through the floating 
15 period of the first turning gait from the start time Ts and reaches 
the second turning gait. The time at which the floor reaction 
force vertical component has increased to a predetermined 
magnitude is set as time Tm. Further, in the latter half of a 
single stance period of the second turning gait, the time at which 
20 the f]oor reaction force vertical component has reduced to a 
certain degree is set as time Ts2 . Further, the gait goes through 
the floating period of the second turning gait and reaches the 
first turning gait. The time at which the floor reaction force 
vertical component has increased to a predetermined magnitude 
25 is set. as time Tm2 . 
[024 0] 

Fig. 16 shows these times. The time Tm is preferably set 
to be the moment substantially the entire surface of the sole 
of the supporting leg foot 22 comes in contact with the ground 
30 or immediately after that. The same applies to time Tm2 . The 
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t.ime ':'s2 Is preferably set to the time of the moment at which 
3he state wherein substantially the entire surface of the sole 
of the? supporting leg foot 22 is in contact with the ground is 
switched to tiptoe contact with the ground or at the time 
5 immediately preceding it, as in the case of the start time Ts. 
1.0241] 

A description will now be given of the relationship between 
the d€:sired ZMP of Fig, 18 and these times Tm, Ts2 and Tm2 set 
in the? afore-mentioned SllO of Fig. 14. In the second turning 

10 gait, the desired ZMP takes the heel of the supporting leg foot 
22 as the beginning position and remains at this position until 
substantially the entire surface of the sole of the supporting 
leg foot 22 comes in contact with the ground, and then the desired 
ZMP begins to move to the center of the supporting leg foot 22 . 

15 It is desired to set this moment the desired ZMP beings to move 
the center as time Tm. Thereafter, the instant the movement of 
the desired ZMP to the tiptoe is completed by the time only the 
tipto^^ of the supporting leg foot 22 comes in contact with the 
ground is preferably set as time Ts2 . Furthermore, in the next 

20 first turning gait, the desired ZMP takes the heel of the 
suppo2"ting leg foot 22 as the beginning position and remains at 
this position until substantially the entire surface of the sole 
of the supporting leg foot 22 comes in contact with the ground, 
and then the desired ZMP begins to move to the center of the 

25 suppoi ting leg foot 22 . It is desired to set this moment the 
desirc^d ZMP begins to move to the center as time Tm2 . 
[02 42] 

The reason for setting as described above will be discussed 
hereinafter . 
30 [0243] 
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A::ter the processing from SOlO to S022 shown in Fig. 12 is 
c^arried out, the processing proceeds to S024 and calculates an 
initial state of the normal gait. The initial state calculated 
here includes an initial horizontal body position/velocity (an 
5 ini ti c^l body position and initial body velocity in the horizontal 
direction? , an initial vertical body position/velocity (an 
initial body position and an initial body velocity in the vertical 
direc^:ion) , an initial divergent component, an initial body 
posture angle, and an angular velocity of the normal gait, and 
10 an in;Ltiai antiphase arm swing angle and an angular velocity. 
The initial state is explorator ily calculated according to the 
flowchart of Fig. 19. 
[3244] 

In the flowchart of Fig. 19, first, in S200, an initial state 
15 (a state at the start time Ts) of a desired foot position/posture, 
a desired arm posture, and a desired body posture angle (an 
inclination angle and a yaw angle) are determined on the basis 
of the gait parameters of the normal gait (the parameters set 
in S022 of Fig. 12 described above) . The state here represents 
20 positions and posture angles and their changing rates (time 
derivative ) . 
[0245] 

In this case, the initial state of a desired foot 
position/posture of a supporting leg is determined by generating, 

25 using a finite-duration setting filter, a foot position/posture 
trajectory (a trajectory observed from a next time's gait 
supporting leg coordinate system) from the supporting leg foot 
position/posture at the start of the first turning gait of the 
foot trajectory parameter determined in SlOO of Fig. 14 to the 

30 free Leg foot position/posture at the end of the second turning 
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gait imti] time Ts is reached. The initial state of a desired 
foot position/posture of the free leg is determined by generating, 
using a finite-duration setting filter, a foot position/posture 
■::rajec:tory from the supporting leg foot position/posture at the 
5 start of the current time gait observed from a next time' s gait 
supporting leg coordinate system to the free leg foot 
posit :.on/p)osture at the end of the first turning gait until time 
Ts is reached. The initial state of a desired arm posture is 
determined to be a reference arm posture at time Ts that is 

10 determined on the basis of the reference arm posture trajectory 
parameters determined in S104 of Fig. 14. To be more specific, 
a total center-of -gravity position of both armsof a desired arm 
postuie, ei lateral interval between right and left hands, and 
an antiphase arm swing angle and an angular velocity are 

15 determined. However, the antiphase arm swing angle and the 
angular velocity are corrected so that they are continuous in 
£i boundary of gaits when a normal gait is repeated, as it will 
be discussed hereinafter; therefore, they have been just 
tiempoiar i I y determined. 

20 For an initial state of a desired body posture angle, a 

reference body posture (an inclination angle and a yaw angle) 
amd ar angular velocity thereof at time Ts determined by the 
reference body posture trajectory parameter determined in S102 
of Fig. 14 are determined as an initial state of the desired body 

25 posture angle. In the present embodiment, the reference body 
posture is a vertical posture, so that the initial state (the 
inclination angle and the angular velocity thereof) of the 
inclination angle in the desired body posture is zero. 
[ C 2 4 6 ] 

30 Further, in the present embodiment, a desired foot 
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posit.:_on/posture trajectory, a floor reaction force vertical 
component trajectory, and a desired ZMP trajectory of a normal 
gait cire determined independently from each other on the basis 
of a foot trajectory parameter, a floor reaction force vertical 
5 component trajectory parameter, and a ZMP trajectory parameter, 
respect iv6?ly, which have been determined in the flowchart of Fig. 
L4 . For example, a desired foot position/posture at each instant 
of a normal gait is determined on the basis of a foot trajectory 
param€5ter without depending on an instantaneous value of a floor 
10 react:_on force vertical component. 
[02 47 ] 

Subsequently, in S202, {Xs, Vxs) (Xs : horizontal position; 
Vxs : horizontal velocity), which is a candidate of an initial 
horiz(3ntai body position velocity (that is, a candidate of the 

15 horizontal body position velocity at the start time Ts), is 
provisionally determined. The candidate (Xs, Vxs) to be 
provisionally determined may be arbitrary. For example, the 
horizontal body position velocity in the initial state of the 
norma!- gait determined when the last time's gait was generated 

20 may be' used as a provisionally determined candidate (Xs, Vxs) . 
[(32 48 ] 

To simplify the explanation, a case where the initial state 
of a normal gait in the X-direction (longitudinal direction) on 
a sagittal plane is searched for will be taken as an example. 
25 However, for the initial state of a normal gait (the initial state 

that meets the aforesaid boundary condition of a normal gait), 
it is actually required to search for the position and the 
veloci-ty in the X direction (longitudinal direction) and the Y 
direction (lateral direction) separately or simultaneously. 
30 [0249] 
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Supplementally, there is no concept related to a yaw rotation 
or a rrioment vertical component or others about a vertical axis 
on the sagi ttal plane . For this reason, at least the yaw rotation 
and a moment vertical component are calculated in a 
three-dimensional space. 

[02 50] 

As an exploratory determining technique, a method in which 
a pseudo- Jacobian (sensitivity matrix) is determined and then 
a next candidate is determined by the steepest descent method 
or the like, or the simplex method or the like may be used. In 
the present embodiment, the steepest descent method will be used. 

[ C 2 5 1 ] 

Next, the processing proceeds to S206 via S204 and determines 
the initial (time Ts) vertical body position velocity (Zs, 
Vzs) (Zs: vertical position; Vzs : vertical velocity) so that the 
vertical body position velocity is continuous and angles of 
joints, such as knees, will not be excessively large or small 
when the normal gait is repeated. More details regarding this 
have been described in, for example, PCT / JPO 2 / 1 3 5 92 previously 
applied by the present applicant, and will be therefore omitted 
here . 

[0252] 

After the processing of S206, the processing proceeds to S208 
to provisionally generate a normal turning gait (the normal 
turning gait provisionally generated may be hereinafter referred 
to as the provisional gait) . To be more specific, based on the 
gait pcirameters of the normal gait determined in S022 of Fig. 
12 described above, a desired ZMP, a desired floor reaction force 
vertical component, a desired f oot posi tion/posture , a reference 
body posture, a desired arm posture, a floor reaction force 



- 132- 



horizonta] component permissible range, and a floor reaction 
force moment vertical component permissible range at each 
instant from the start time Ts to the end time Te are sequentially 
determined. Then, gaits from time Ts to the end time Te are 
generated by sequentially determining the body position/posture, 
taking the horizontal body position velocity (Xs, Vxs) and the 
vertic:al body position velocity (Zs, Vzs) mentioned above as the 
initial (time Ts) state of the body 3, and by using the aforesaid 
dynamic model (the model in Fig. 10) so as to satisfy the dynamic 
balance condition related to the determined desired ZMP and the 
desired floor reaction force vertical component and the 
condition of the floor reaction force horizontal component 
permissible range. At this time, the gaits are generated so that 
the body posture agrees with the reference body posture as much 
as possible . 

Moreover, an antiphase arm swing motion is determined such 
that the condition related to the floor reaction force moment 
vertical component, i.e., the floor reaction force moment 
vertical component permissible range, is satisfied. 

[ 0253] 

Incidentally, the gait generation of the normal gait is 
performed merely inside the gait generator 100, and the generated 
gaits are not output to a composite-compliance operation 
determiner 104, which will be discussed later, as desired values 
for driving the actual robot 1. 

[0254] 

The following will explain in detail the processing for 
genera-ing a normal gait by sequential calculation, which is the 
processing in S208. 

[0255] 
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F-Lg. 20 is a subroutine flowchart illustrating the 
pr oces sing. 
[02561 

The explanation will now be given . In S3 00, various elements 
are initialized. Specifically, the start time Ts is substituted 
.into time k for generating a provisional gait. Furthermore, a 
currently determined (Xs, Vxs) (determined in 8202, or S216 or 
S218 of Fig. 19 to be discussed hereinafter) is substituted into 
the horizontal body position velocity, and the latest (Zs, Vzs) 
determined in the aforesaid S206 is substituted into the vertical 
body position velocity. In addition, an initial value of a 
reference body posture angle (angle at the start time Ts) is 
substituted into the body posture angle, and an initial value 
of a reference body posture angular velocity (an angular velocity 
at the start time Ts) is substituted into the body posture angular 
veloci ty . 

A reference initial £intiphase arm swing angle (angle at the 
start time Ts) is substituted into the antiphase arm swing angle, 
and a reference initial antiphase arm swing angular velocity 

(angular velocity at the start time Ts) is substituted into the 
antiphase arm swing angular velocity. 
[0257] 

Subsequently, the processing proceeds to 8304 via S302 and 
determines whether time k for generating a provisional gait is 
before gait end time (whether k < Ts + Tcyc) . If the determination 
result is YES, then the processing proceeds to a gait 

instantaneous value determining subroutine of S306 to determine 
a gait instantaneous value. Subsequently, the processing of the 
gait generator 100 proceeds to S308 to increment time k for 
generating a provisional gait by Ak, and then returns to S304. 
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[ 0258 1 

He^re, Ak is an interval of the generation of provisional 
gaits and normally set to agree with a control cycle At. If the 
dynamic accuracy of provisional gaits is not demanding, then Ak 
5 nay he- set to be longer than At in order to reduce the volume 
of caJculation. 
[ 0259] 

II" the determination result of S304 is NO, then the 
processing proceeds to S310. The processing described above 
!0 generates a normal gait (provisional gait) from its start to end 
before proceeding to S310. 
[02 60] 

A gait instantaneous value determining subroutine of S306 
will row be explained in detail with reference to Fig. 21. 
15 [0261] 

First, in S400 of Fig. 21, based on a normal gait parameter 
(the floor reaction force vertical component trajectory 
parameter) , a value (current time value) of the desired floor 
reaction force vertical component shown in Fig. 16 at time k is 
20 de teriTiined . Further, in S402, a value (current time value) of 
the desired ZMP trajectory shown in Fig. 18 at time k is determined 
on the basis of a normal gait parameter (the ZMP trajectory 
parameter ) . 
[0262] 

25 Then, the processing proceeds to S404 and determines the 

values (current time values) of desired posi t ions /pos tures of 
both feet (desired foot positions/postures of both supporting 
leg anci free leg) , the reference body posture, and the reference 
arm posture at time k on the basis of the normal gait parameters 

30 (the foot trajectory parameter, the reference body posture 
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L. r a ;i ect: or y parameter , and the arm posture trajectory parameter ) . 
To be more specific about the reference arm posture, the values 

(current time values) of the total center-of -gravity position 
of both arms, the lateral interval between right and left hands, 
and the antiphase arm swing angle are determined. 
[ 0263 J 

Tlie current time value (the value at time k) of the desired 
foot position/posture is determined in the same manner as in the 
case v/here the foot position/posture at the start time Ts was 
determined in S200 of Fig. 19. 

[0264] 

Then, the processing proceeds to S406 and calculates a value 
;curr€?nt time value) of the total center-of -gr a vi t y vertical 
position velocity at time k that satisfies the desired floor 
reaction force vertical component (balances the sum of the 
inertial force in the vertical direction and gravity of the robot 
1 with the desired floor reaction force vertical component) . To 
be more specific, the total center-of -gravity vertical position 
velocity is calculated on the basis of, for example, the above 
Equation Q] and Equation 04 related to the dynamic model shown 
in F'ig. 10. In other words. Equation 01 and Equation 04 provides 
a relational expression (a dynamic equation related to the 
vertical direction of the total center of gravity of the robot 
1 ) indicating that the result obtained by multiplying the sum 
of th€' total center-of -gravity vertical acceleration from a 
motion of the robot 1 and the gravity acceleration by the total 
mass of the robot 1 is equal to a floor reaction force vertical 
component. Thus, the total center-of -gravity vertical 

acceleration is determined from the relational expression and 
the desired floor reaction force vertical component. 
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[ 02 6 5:; 

The relational expression itself generally holds without 
depending on a model of the robot 1 . The total center-of -gravity 
vertic:al velocity is calculated by integrating the determined 
total center-of-gravity vertical acceleration, and further, the 
total center-of-gravity vertical velocity is integrated to 
calculate the total center-of-gravity vertical position. More 
generally, these calculations are carried out using the dynamic 
irelational expressions represented by the following Equation 15 
and Equation 16 (discretized equations of Newton's dynamic 
equa ti ons ) . 

[02 66] 

Total center-of-gravity vertical velocity at time k 

Total center-of-gravity vertical velocity at time (k-Ak) 
+ ((Floor reaction force vertical component /Total mass of the 
robot) -h acceleration of gravity) * Ak 

(where the acceleration of gravity takes a negative value) 
... Equation 15 

[0267] 

Total center-of-gravity vertical position at time k 

- Total center-of-gravity vertical position at time (k-Ak) 

-f Total center-of-gravity vertical velocity at time k * Ak 

... Equation 16 

[0268] 

Subsequently, the processing proceeds to S408 and calculates 
the vertical body position that satisfies the total 
center-of-gravity vertical position. To be more specific, the 
vertical body position is calculated using, for example. 
Equation 04 related to the model in Fig. 10. Specifically, the 
vertical, positions of the supporting leg mass point 2m and the 
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free J. eg mass point 2m of the model in Fig. 10 are determined 
from the current time values of the desired foot 
posit ions /postures of the supporting leg and the free leg. Then, 
these determined vertical positions of the supporting leg mass 
point 2m and the free leg mass point 2m and the current time value 
of the total center-of -gravity vertical position determined in 
S407 are applied to Equation 04 so as to determine the vertical 
position of the body mass point 3m. Furthermore, the vertical 
body position is determined from the determined vertical 
position of the body mass point 3m and the current time value 
of the desired body posture angle (the reference body posture 
angle set in S404 or the last time's (time k-Ak) desired body 
posture angle determined in S414 to be discussed hereinafter) . 
[0269] 

The processing then proceeds to S410 wherein the values 
(current time value), at time k, of the floor reaction force 
horizontal component permissible range [Fxmin, Fxmax] shown in 
Fig. 17 are determined on the basis of the gait parameter (the 
parameter defining the floor reaction force horizontal component 
permissible range) determined in S108 of Fig. 14 described above. 
[0270] 

Subsequently, the processing proceeds to S411 wherein the 
values (current time value), at time k, of the floor reaction 
force moment vertical component permissible range [Mzmin, Mzmax] 
shown j.n Fig. 41 are determined on the basis of the gait parameter 

(the peirameter defining the floor reaction force moment vertical 
component permissible range) determined in S109 of Fig, 14 
descrioed above. 
[0271] 

Then, the processing proceeds to S412 wherein the current 
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t:ime values of the desired body horizontal acceleration and the 
desireid body posture acceleration are determined such that the 
dynamic balance condition related to the desired ZMP (the 
condition in that the horizontal component of a moment generated 
aibout the desired ZMP by a resultant force of an inertial force 
and the gravity of the robot 1 is zero) is satisfied. The body 
ho rizcntal acceleration and the body posture angular 
6iCceleration (more specifically, the body inclination angular 
acceleration) are determined such that the floor reaction force 
horizontal component Fx does not exceed [Fxmin, Fxmax] . Further, 
the current time value of the desired antiphase arm swing angular 
acceleration is determined such that the floor reaction force 
moment vertical component Mz does not exceed [Mzmin, Mzmax] . 

Of the body posture angle, the yaw angle is determined so 
as to agree with the yaw angle of the reference body posture angle . 
Regarding the desired arm posture, components other than the 
antiphase arm swing angle are determined to agree with the 
reference arm posture. At this time, the desired body 
inclination angle and the desired antiphase arm swing angle are 
determined to follow the reference body inclination angle and 
the reference antiphase arm swing angle, respectively, as much 
as possible, while satisfying the aforesaid condition. This 
will be explained in detail below. 

[0272] 

At this point, the instantaneous values (current time 

values) of the foot position/posture and the vertical body 
position have been determined as described above. Regarding the 
arm posture, the components other than the antiphase arm swing 
angle have been determined to agree with those of the reference 
arm posture. Therefore, once the remaining horizontal body 
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positjon, body posture angle and antiphase arm swing angle are 
determined, then the desired motion of the robot 1 will be 
uniqu€'ly determined. Hence, all floor reaction forces will be 
also .iniquely determined. In the present embodiment, the 
5 desire'd floor reaction force vertical component and the desired 
ZMP of a normal gait are defined by the floor reaction force 
vertic-al c:omponent trajectory parameter and the desired ZMP 
trajec:tory parameter, respectively, determined in S022 of Fig. 
12 de:5cribed above. 
10 [0273] 

When generating a gait, if the body inclination mode is 
primarily used to satisfy a desired ZMP (to set the horizontal 
compor.ent of a floor reaction force moment about a desired ZMP 
to zero) without using the aforesaid body translat ional mode, 

15 then the body posture angle may become excessively large. To 
prevent this, therefore, the body translational mode should be 
used as much as possible. However, the body translational mode 
involves floor reaction force horizontal component changes, so 
that slippage may occur if the body translational mode is 

20 intensely effected when the floor reaction force horizontal 
component permissible range is narrow. In this case, depending 
upon the body inclination mode is an inevitable choice. 
E-specially during a period in which the floor reaction force 
horizontal component permissible range is zero, as in the 

25 aforesaid running gait, it is impossible to generate a gait for 
generating a floor reaction force horizontal component. Hence, 
depending upon the body inclination mode is an inevitable choice . 
[02 74] 

Meanwhile, an antiphase arm swing motion allows only the 
30 floor reaction force moment vertical component to be changed 
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without changing any of the horizontal component of a floor 
react. Lon force moment about a desired ZMP and the floor reaction 
force horizontal component, so that it can be used to prevent 
the floor reaction force moment vertical component from 
5 exceeding the aforesaid floor reaction force moment vertical 
component permissible range. Considering the above, in the 
present embodiment, the body horizontal acceleration, the body 
posture angular acceleration, and the antiphase arm swing 
acceleration are determined according to the flowchart shown in 
10 Fig. 22. 

[ tD 2 7 5 ] 

First, in S500, the value of the reference body yaw angle 
at time k is substituted into the desired body yaw angle . Further, 
the v^ilue of a reference arm posture at time k is substituted 
15 into the desired arm posture, excluding the antiphase arm swing 
angle and the angular velocity component of an arm posture. 
[0276] 

Then, in S502, it is determined whether the current time (the 
value of a timer for generating a normal gait) k is in the period 
20 of restoring a body posture angle and an antiphase arm swing angle 
{the period of restoring a body posture angle and an antiphase 
arm sv/ing angle being the period from time Tm to time Ts2 and 
the period from time Tm2 to Te in the case of a normal gait) . 
The processing proceeds to S504 if the determination result of 
25 S502 j.s NO, or to S530 if the determination result is YES. 
[ 0277] 

In S504, a body horizontal acceleration atmp necessary to 
satisfy the current (time k) desired ZMP is determined, assuming 
that the robot 1 is maide to perform a motion of the body 
.30 tr ansla t ional mode, the angular acceleration of the body 
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inclination mode being set to zero, from a last time's 
instantaneous gait state (the gait state at time k-1) of the robot 
I. The atmp is determined using, for example, the above Equation 
03y related to the dynamic model of Fig. 10 described above. To 
be more specific, for example, time series values of desired foot 
pos i t :..ons /pos tures determined by the current time k are used to 
deternine the vertical accelerations of the supporting leg mass 
point 2m and the free leg mass point 2m at the current time k, 
and a desired foot position/posture at the current time k (current 
time) is used to determine the vertical positions of the 
suppoirting leg mass point 2m and the free leg mass point 2m. 
Furthermore, the floor reaction force vertical position at the 
current time k (current time) is used to determine the vertical 
position of the body mass point 3m, and the vertical acceleration 
of the body mass point 3m at the current time k is determined 
by using time series values of the desired vertical body positions 
determined by the current time k. Then, these determined values 
are substituted into the above Equation 03y, and an equation 
obtained by setting My and d2eby/dt2 of the Equation 03y to zero 
is solved on d2Xb/dt2 so as to determine the body mass point 
horizc-ntal acceleration eis the body horizontal acceleration atmp. 
A more precise dynamic model may be used to explorator ily 
determine the body horizontal acceleration atmp that sets the 
horizontal component of the floor reaction force moment about 
the desired ZMP to zero. Further, in the present embodiment, 
the reference body posture is the vertical posture and the body 
posture angular acceleration in the reference body posture is 
zero, so that the angular acceleration in the body inclination 
mode was set to zero to determine the body horizontal acceleration 
atmp. If, however, the reference body posture trajectory 
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parame^ter is set so that the inclination angle of the reference 
body p^osture changes and if the reference body posture angular 
accele^ration at the current time k determined thereby is not zero, 
then the angular acceleration in the body inclination mode may 
be set to the value of that reference body posture angular 
ciccele-ration, which is not zero, to determine the body horizontal 
accele-ration atmp by using a dynamic model (for example, 
d29by/dt2 of Equation 03y may be set to a reference body posture 
angular acceleration that is not zero to determine the body 
horizontal acceleration atmp in the same manner as described 
above) . 

[027 8 1 

Next, the processing proceeds to S506 wherein a floor 
reaction force horizontal component Fxtmp at time k when the body 
horizontal acceleration is atmp is determined using a dynamic 
model. In the present embodiment, Fxtmp is determined using 
Equation 02 of the dynamic model. In other words, Fxtmp is 
determined according to the following Equation 17, where 
d2Xsup/dt2 and d2Xswg/dt2 denote the supporting leg foot mass 
point horizontal acceleration and the free leg foot mass point 
horizontal acceleration , 

[0279] 

Fxtmp - mb ^ atmp + msup ^ d2Xsup/dt2 

+ mswg * d2Xswg/dt2 ... Equation 17 
[0280] 

An example of Fxtmp determined as described above is shown 
in Fig. 23. In Fig. 23, a portion wherein Fxtmp exceeds the floor 
reaction force horizontal component permissible range [Fxmin, 
Fxmax] is hatched. 

[0281] 
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Subsequently, the processing proceeds to S508 wherein a body 
hor i z(.:>ntal acceleration oc in the body t ranslational mode and a 
floor reaction force horizontal component Fx generated thereby, 
and a body angular acceleration |3 in the body inclination mode 
are determined as shown below (S508 to S516). 

[02821 

Specifically, if Fxtmp > Fxmax, then the processing proceeds 
to S510 wherein Fx is determined according to the following 
equat :.on . 

[0283] 

Fx ^ P'xmax... Equation 18 
[ 0284 ] 

If Fxtmp < Fxmin, then the processing proceeds to S512 
wherein Fx is determined according to the following equation. 
[ 0285] 

Fx = Fxmin... Equation 19 
[0286] 

In other cases, that is, if Fxtmp lies within the floor 
reaction force horizontal component permissible range [Fxmin, 

Fxmax] , then the processing proceeds to S514 wherein Fx is 
determined according to the following equation. 
[C287] 

Fx = Fxtmp... Equation 2 0 
[ C 2 8 8 ] 

In any case, the processing proceeds to S516 wherein the body 
horizontal acceleration a and the body posture angular 

acceleration (body inclination angular acceleration) (3 are 
determined according to the following equations. 
[0289] 

a = atmp + ( Fx- Fxtmp ) /AFp. . . Equation 21 

- 144- 



[ 02 90 I 

p (atmp-a) * AMp/AMr... Equation 22 
[02 91] 

Where, AFp, AMp, and AMr are determined according to the 
above Equations 06, 07, and Equation 09, respectively. 

[02 92] 

Supplementally, if higher accuracy of the dynamic 
calcul.ation is required, then, after determining the body 
angular acceleration p as described above, the body horizontal 
acceleration a in the body translational mode should be 
analytically or exploratori ly determined by using a more precise 
dynami.c model so that a motion obtained by combining the body 
transJ-a tional mode and t,he body inclination mode of the above 
determined body angular acceleration |3 satisfies the desired ZMP 
As an exploratory determining method, a method in which a 
pseudo- Jacobian (sensitivity matrix) is determined and then a 
next candidate is determined by the pseudo-Newton method or the 
like, or the simplex method or the like may be used, 

[0293] 

Further, in order to strictly prevent the floor reaction 
force horizontal component Fx from exceeding the floor reaction 
force horizontal component permissible range [Fxmin, Fxmax], a 
set of the body horizontal acceleration a and the body angular 
acceleration p may be eexplorator i ly searched for such that 
Fx=Fxmax and the horizontal component of the floor reaction force 
moment about the desired ZMP is zero in S510 and also Fx=Fxmin 
and the horizontal component of the floor reaction force moment 
about the desired ZMP is zero in S512. 

[0294] 

Fig. 24 shows Fx determined as described above. Fx has been 
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I_Lmit(3d (saturated) so that a value of Fxtmp does not exceed the 
floor reaction force horizontal component permissible range 
[Fxmin, Fxmax]. More sp)eci f ically , Fxtmp is directly used as 
Fx if Fxtmp based on the body horizontal acceleration atmp only 
by the body translat ional mode lies within the permissible range 
[Fxmin, Fxmax] . If Fxtmp based on the body horizontal 
acceleration atmp only by the body trans lat ional mode exceeds 
an upper limit of the permissible range [Fxmin, Fxmax] or reduces 
below a lower limit thereof, then Fx is forcibly limited to Fxmax 
and Fxmin, respectively. Especially in a floating period of a 
running gait, Fxmax=Fxmin==0 applies all the times, so that Fx=0 . 
[0295] 

Fig. 25 shows the body posture angular acceleration p 
determined as described above. Thus, an insufficient portion 
of the floor reaction force moment caused by limiting the 
acceleration in the body translational mode so as to prevent Fx 
generated by the body translational mode from exceeding the 
permissible range [Fxmin, Fxmax] (more specifically, the moment 
obtained by subtracting a moment component produced by a limited 
body horizontal motion and the motions of both legs 2, 2 from 
an inertial force moment required for reducing the horizontal 
component of a floor reaction force moment about the desired ZMP 
to zero) has been compensated for by the body inclination mode. 
During a floating period of a running gate, the body horizontal 
acceleration of by the body translational mode is always limited 
to zero, so that the insufficient portion of the floor reaction 
force moment is compensated for only by the body posture angular 
acceleration p by the body inclination mode. 

[0296] 

Subsequently, the processing proceeds to S518 to determine 
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a floor reaction force moment vertical component Mztmp when a 
motion in which, for example, a body horizontal acceleration in 
the bc:)dy translat ional mode is oc, a body angular acceleration 
(body inclination angular acceleration) in the body inclination 
mode is p, a body acceleration in the body yaw rotation mode {body 
yaw angular acceleration) is a reference yaw angular 
accelearation d2 ebz re f /dt 2 , and an antiphase arm swing angular 
acceleration pa is a reference antiphase arm swing angular 
acceleration d2 Ga z re f /dt2 , is performed. Hereinafter, 
d2ebzref/dt2 will be pbref, and d2eazref/dt2 will be paref. 
[0297] 

To be more specific, Mz obtained by substituting Equation 
1001 t.hrough Equation 1004 into Equation 03z is Mztmp. 

[0298] 

d2Xb/dt2 = ax... Equation 1001 
[0299] 

d2Yb/dt2 = ay... Equation 1002 
[0300] 

d2ebz/dt2 = pbref... Equation 1003 

[ 3 0 1 ] 

d2eaz/dt2 = paref... Equation 1004 
[ C 3 0 2 ] 

where ax denotes an X component of the body horizontal 
acceleration a; ay denotes a Y component of the body horizontal 
acceleration a. Furthermore, A horizontal body position at time 
k-1 is substituted into Xb and Yb, and a value of time k is 
substituted into Xzmp, Yzmp, Xsup, d2Ysup/dt2, Xswg, and 
d2 Yswg/dt2 . 

[0303] 

Fig. 4 3 shows an example Mztmp determined as described above. 
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In Fig, 43, the portions of Mztmp that exceeds the floor reaction 
force moment vertical component permissible range [Mzmin, Mzmax] 
are shown by hatching. 
[ 3304 ] 

Next, the processing proceeds to S520 wherein an antiphase 
arm sv/ing angular acceleration |Sa is determined as shown below 

(S520 ^ S528) . 
[0305] 

Specifically, if Mztmp > Mzmax, then the processing proceeds 
to S522 wherein Mz is determined according to the following 
equat:.on . 

[ 0306] 

Mz - Mzmax... Equation 1018 

I 0307 J 

I:: Mztmp < Mzmin, then the processing proceeds to S524 
wherexn Mz is determined according to the following equation. 

[0308] 

Mz = Mzmin... Equation 1019 

[0309] 

In other cases, that is, if Mztmp lies within the floor 
2:eacti.on force horizontal component permissible range [Mzmin, 
Mzmax], then the processing proceeds to S526 wherein Mz is 
determined according to the following equation. 

[0310] 

M2: = Mztmp... Equation 1020 

[ C' 3 1 1 ] 

iT: any case, the processing proceeds to S528 wherein the 
antiphase arm swing angular acceleration (3a is determined 
according to the following equation. 

[C312] 
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(3a - paref + ( Mz tmp-Mz ) / AMa z . . . Equation 1021 
[0313] 

where AMaz is determined according to Equation 09a. 
[ 3 3 1 4 J 

Tne following will explain the processing from S518 to S528. 

[ 3315] 

M^. determined as described above denotes a floor reaction 
force moment vertical component from a motion of the entire robot, 
including an antiphase arm swing. 

[0316] 

In the above processing, the antiphase arm swing angular 
acceleration pa has been determined such that the Mz does not 
exceed the floor reaction force moment vertical component 
permissible range [Mzmin, Mzmax] . Too be more specific, as shown 
in Fig. 44, Mz has been determined to be limited (saturated) so 
that a. value of Mztmp does not exceed the floor reaction force 
horizontal component permissible range [Mzmin, Mzmax] . More 
detaiJ.edly, Mztmp is directly used as Mz if Mztmp lies within 
the permissible range [Mzmm, Mzmax] . If Mztmp exceeds an upper 
limit of the permissible range [Mzmin, Mzmax] or reduces below 
a lower limit thereof, then Mz is forcibly limited to Mzmax and 
Mzmin, respectively. Especially in a floating period of a 
running gait, Mzmax=Mzmin=0 applies all the times, so that Mz = 0 . 

[0317] 

A moment vertical component Maz to be generated by an 

antiphase arm swing in order to prevent Mz from exceeding the 
floor reaction force moment vertical component permissible range 
[Mzmin, Mzmax] is (Mz~Mztmp) . Maz(= Mz-Mztmp) is shown in Fig. 
45 . 

[0318] 
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Tne antiphase arm swing angular acceleration |3a can be 
obtained by adding the result obtained by dividing Maz by an 
equivalent inertial moment AMaz of an antiphase arm swing to a 
reference antiphase arm swing angular acceleration paref (a 
value obtained by subjecting a reference antiphase arm swing 
angle to second order differentiation) . Specifically, (3a is 
determined according to the above Equation 1021. The antiphase 
arm swing angular acceleration (3a is shown in Fig. 46. 

[0319 1 

As described above, in the processing from S504 to S528, the 
antiphase arm swing angular acceleration (3a is determined such 
that the floor reaction force moment vertical component Mz 
generated by a motion of the entire robot, including an antiphase 
arm swing, does not exceed the permissible range [Mzmin, Mzmax] 
(such that the floor reaction force moment vertical component 
Mztmp offsets (cancels) the portion of the floor reaction force 
moment: vertical component Mztmp that exceeds the permissible 
range, the floor reaction force moment vertical component Mztmp 
being generated when an antiphase arm swing angular acceleration 
-s set to agree with the reference antiphase arm swing angular 
accel€; ra t i on (3aref ) . 

[0320] 

Supplementally, to strictly prevent the floor reaction force 
moment, vertical component Mz from exceeding the floor reaction 
force moment vertical component permissible range [Mzmin, Mzmax] , 
the antiphase arm swing angular acceleration (3a should be 
analytically or expl or a tor i 1 y searched for by using a more 
precise dynamic model in place of the processing from S504 to 
S528. As an exploratory determining method, a method in which 
a pseudo- Jacobian (sensitivity matrix) is determined and then 
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a next candidate is determined by the pseudo-Newton method or 
the like, or the simplex method or the like may be used. 

[03211 

The above processing is performed if time k is not found 
5 durinq the period of resstoring a body posture angle and an 

antiphiase arm swing angle. 

[0322 ] 

If a determination result of S502 is YES, then the following 
processing will be carried out. First, the processing proceeds 

10 to S530 wherein the body horizontal acceleration a required to 
satisfy the desired ZMP of current time (time k) when the angular 
accel€^rat ion in the body inclination mode is set to zero from 
the last time's instantaneous gait state (the gait state at time 
k-1) of the robot 1 so as to make the robot 1 perform a motion 

15 of the body trans lational mode is determined, and this is 
determined as a final body horizontal acceleration. 
[ 0323] 

Nf3xt, the processing proceeds to S532 wherein the floor 

reaction force horizontal component Fx in the aforesaid case is 
20 determined. 

[0324] 

Ne^xt, the processing proceeds to S534 wherein the body 
postuire angular acceleration (3 is determined to be zero. 

[0325] 

25 Lastly, the processing proceeds to S536 wherein the 

referemce antiphase arm swing angular acceleration (3aref (the 
value obtained by subjecting the reference antiphase arm swing 
angle to second order differentiation) is substituted into the 
antiphase arm swing angular acceleration pa. 

30 [0326] 
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Th€5 above is the processing carried out if the determination 
result of 3502 is YES. More specifically, in this case, the body 
posture angular acceleration is set to zero (more precisely, to 
agree with the reference body posture angular acceleration) , and 
the antiphase arm swing angular acceleration is set to agree with 
a reference antiphase arm swing angular acceleration. It is 
expected that this setting will not cause a floor reaction force 
generated by a motion to exceed the floor reaction force 
horizontal component permissible range and the floor reaction 
force moment vertical component permissible range; therefore, 
determining as described above will present no problem. 

[0327J 

After the processing of S528 or S536, the processing proceeds 
to S4:_4 of Fig. 21 wherein the body horizontal acceleration 
determined in S412 is sequentially integrated (cumulative 
addition from time Ts to current time k) so as to determine a 
horizc>ntal body velocity, and further, the horizontal body 
velocity is sequentially integrated (cumulative addition from 
time Ts to current time k) so as to determine a horizontal body 
position (current time value) . Further, the body posture 
angular acceleration determined in S412 is sequentially 
integrated (cumulative addition from time Ts to the current time 
k) so as to determine a body posture angular velocity, and further, 
the body posture angular velocity is sequentially integrated 
(cumulative addition from time Ts to the current time k) so as 
to determine a body posture angle (current time value) . 

[0328] 

The processing then proceeds to S416 wherein the antiphase 
arm swing acceleration (3a is sequentially integrated (cumulative 
addition from time Ts to the current time k) so as to determine 
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an antiphase arm swing velocity, and further, the determined 
antiphase arm swing velocity is sequentially integrated 
(cumulative addition from time Ts to the current time k) so as 
to determine an antiphase arm swing angle Gaz (current time 
5 va 1 ue ) . 

[0329] 

After the normal gait instantaneous value determining 
subroutine of S306 in Fig. 20 is carried out, the processing 
proceeds to S308 wherein the value of time k for generating a 

10 gait is incremented by a gait generation interval Ak. Then, the 
processing returns to S304 to repeat the processing of S306 and 
S308 as long as the condition shown in S304 is satisfied. When 
the condition shown in S304 is no longer satisfied, that is, when 
the generation of provisional gaits up to the end (time Te = 

15 Ts+Tcyc) is completed, the processing proceeds to S310. 
[0330] 

For a normal gait, an initial body posture angle and its 
angular velocity must be determined such that motional states 
of the robot 1 are not discontinuous at boundaries when the normal 
20 gait is repeated. 
! 0331 ] 

Pience, in S310, a pattern of a ZMP-conver ted value 
(hereinafter referred to as the body posture restoring moment 
ZMP-converted value and abbreviated to ZMPrec) of a floor 
25 reaction force moment for generating a body posture angular 

acceleration for setting a body posture angular velocity back 
to ar initial value (the value at time Ts) by time Te is set. 
I 0332] 

This will be explained in detail below. 
30 10333] 
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The following will discuss the procedure for setting a body 
posture angular velocity back to an initial value (the value at 
time Ts) by generating a body posture angular acceleration by 
using the body inclination mode during the period of restoring 
5 a body posture angle and an antiphase arm swing angle (the period 
from -:,ime Tm to time Ts2 and from time Tm2 to Te) . A body posture 
angular acceleration pat. tern for this purpose is denoted by (3 (k) . 
In periods other than the above-mentioned period, P(k)=0 will 
apply . 
10 [0334] 

In the body inclination mode, generating the body posture 

angular acceleration p(k) will generate a floor reaction force 
moment p!;k)^AMr. As a result, if the floor reaction force 
vertical component at that instant is denoted by Fz{k), then 
15 ZMP(k) calculated from a motion (rather than a desired ZMP) will 
be snifted by AZMP determined according to the following 
equal i on . 

10 3 3 5] 

/^ZMP(k) = -p ( k) * AMr/Fz ( k) ... Equation 23 
20 i033 6] 

Therefore, if the pattern of AMr and the pattern of Fz(k) 
have been determined (known), then the body posture angular 
velocity can be set back to the initial value (the value at time 
Ts), that is, the body posture angular velocity in an initial 
25 (time Ts) state of the reference body posture trajectory by 
appropriately setting a pattern of AZMP(k) to generate a body 
posture angular acceleration pattern that satisfies Equation 23. 
•:0337] 

^?he aforesaid body posture restoring moment ZMP-conver ted 
30 valu€5 (ZMPrec) means AZMP(k) that has been appropriately set as 
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described above. Strictly speaking, AMr varies when setting the 
body Dosture restoring moment ZMP-converted value by using the 
above Equation 23, but it may be approximately set at a constant 
value. This is because the normal gait is merely generated for 
5 temporary use and not used to make an actual robot follow the 
gait, so that the dynamic accuracy of a normal gait does not have 
to be very high. 
[0338] 

Fig. 26 illustrates an example of ZMPrec . In Fig. 26, as 
10 a pattern of ZMPrec, trapezoidal patterns are formed for the 
period from time Tm to time Ts2 and for the period from time Tm2 
to time Te . The times of break points of the trapezoidal portions 
are set to agree with the times of break points of a desired ZMP 
pattern in the period between time Tm and time Ts2 and the period 
15 from Tm2 to Te (refer to Fig. 18). This is because correction 
of the desired ZMP pattern of a current time gait will be easier, 
as it will be discussed hereinafter. 
10 3 3 9] 

Substituting ZMPrec (k) into AZMP(k) of Equation 23 provides 
20 the following equation. 
[0340] 

f>(k) = -ZMPrec (k) *Fz (k) /AMr... Equation 24 
[0341] 

Therefore, p{k) determined in this Equation 24 will be as 
25 indicated by the solid lines in Fig. 27. The dashed lines in 
Fig. 27 indicate the body posture angular acceleration during 
the period from time Ts to time Tm and the period from time Tm2 
to Te (indicated by the solid lines in Fig. 25) . (Hereinafter, 
(k) may be omitted if a value is obviously the value at time k.) 
30 10342] 
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The initial (time Ts) body posture angle is set to agree with 
the initial (time Ts) reference body posture angle. 
[0343] 

Further, the initial body posture angular velocity is 
5 determined to satisfy Equations 37a and 37b. 

[0344] 

Terminal body posture angle - Initial body posture angle 

Second order integration of a body posture angular 
acceleration that has been determined to satisfy a floor reaction 
10 force horizontal component permissible range 

+ Second order integration of a body posture angular 
acceleration generated by ZMPrec 

4- Initial body posture angular velocity ^ Cycle of normal gait 

Equation 37a 

15 [0345] 

Terminal body posture angular velocity - Initial body posture 
angular velocity 

First order integration of a body posture angular 
acceleration that has been determined to satisfy a floor reaction 
20 force horizontal component permissible range 

+ First order integration of a body posture angular 
acceleration generated by ZMPrec 

Equation 37b 

I. 0346] 

25 The integration period of the first term of the right side 

of ea3h of Equations 37a and 37b is the period combining the period 
from time Ts to Tm and the period from Ts2 to Tm2 , while the 
integration period of the second term of the right side is the 
period combining the period from time Tm to Ts2 and the period 

30 from Tm2 to Te . 



- 156- 



[0347] 

To explain more specifically, in a normal gait, an initial 
state posture angle and an angular velocity observed from a 
supporting leg coordinate system of a first turning gait (the 
5 next ~ime' s gait supporting leg coordinate system) must agree 
with a terminal body posture angle and angular velocity, 
respectively, observed from a supporting leg coordinate system 
of the next first turning gait (the next but two time's gait 
supporting leg coordinate system). Therefore, in the present 
10 embodiment, the initial (time Ts) body posture angle is 
determined to be the value of the initial (time Ts) reference 
body posture angle, and this value and the value obtained by 
subjecting this value t:.o coordinate conversion into a value 
observed from the next time's gait supporting leg coordinate 
15 system by a matrix (matrix of rotational coordinate conversion) 
based on a total turning angle (turning angle about a vertical 
axis) of the robot 1 in a normal gait are substituted into the 
initial body posture angle and the terminal body posture angle, 
respectively, in the left side of Equation 37a. The body posture 
20 angular acceleration determined in S518 of Fig. 22 described 
above is used as the body posture angular acceleration related 
to the integration of the first term of the right side of Equations 
3 '7 a and 3 7b. 

[0348] 

25 Then, the initial body posture angular velocities of 

Equations 37a and 37b and the heights of the trapezoids of ZMPrec 
(the trapezoidal patterns shown in Fig. 26) related to the 
integration of the second terms of the right sides of Equations 
37a and 37b are taken as unknown numbers (However, the times of 

30 the break points of the trapezoidal patterns of ZMPrec are 
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deter-nmed beforehand. Further, a trapezoidal height acycl of 
ZMPrec of a first turning gait and a trapezoidal height acyc2 
of ZMPrec of a second turning gait are set to have the same value. ) 
An initial body posture angular velocity determined by solving 
5 the s:.mul taneous equation of Equations 37a and 37b including the 
unknown numbers is decided as a new initial body posture angular 
velocity. In this case, the terminal body posture angular 
velocity in Equation 37b is obtained by coordinate-converting 
the initial body posture angular velocity, which is an unknown 
10 number, into a value observed from a next time's supporting leg 
coordinate system by a matrix based on the above total turning 
angle of a normal gait. 
[0349] 

Subsequently, the processing proceeds to S312 wherein an 
15 amount of influence exerted by a body inclination restoring 
moment ZMP-conver ted value (ZMPrec) pattern on a horizontal body 
position and a velocity is determined on the basis thereof, and 
the determined amount is added to the horizontal body position 
and velocity at an end. 
20 [03 50] 

This processing will be explained (refer to PCT/ JP02/13592 
for details) . 
[0351] 

During the period from time Ts to Tm and the period from time 
25 Ts2 to Te, if the body posture angular acceleration (3 is changed 

to generate the body inclination restoring moment ZMP-conver ted 
value (ZMPrec) pattern, as described above , then the body posture 
angular acceleration (3 is determined according to the following 
equation . 
30 [0 352] 
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P -= -ZMPrec^Fz/AMr... Equation 1025 
[0353] 

The body horizontal acceleration that satisfies the desired 
ZMP when no body inclination restoring moment is generated is 
5 atmp as determined in S532 . When the body posture angular 
acceleration p is changed as described above^ the body horizontal 
acceleration a required to satisfy the desired ZMP is determined 
according to the following equation. 
[0354] 

10 a = atmp - (AMr/AMp) ^ p... Equation 1026 

[0355] 

From Equations 1025 and 1026, 

a atmp + ZMPrec ^ Fz/AMp.., Equation 1027 
[0356] 

13 In other words, the acceleration is increased by an 

equivalent to the second term of the right side of Equation 1027 
by the body inclination restoring moment ZMP-converted value 
( ZMPrec) . 

[03 57] 

20 Using the linearity of the equations, the body horizontal 

velocity at an end obtained when the body posture angular 
acceleration p is changed to generate the body inclination 
restoring moment ZMP-converted value (ZMPrec) pattern as 
described above will be determined by adding the first order 

25 integration of ( ZMPrec^Fz/AMp) from time Ts to Te to the body 
horizontal velocity at an end obtained when the body inclination 
restoring moment ZMP-converted value (ZMPrec) pattern is not 
generated, i.e., the end value of the body horizontal velocity 
determined in S414. Further, the horizontal body position at 

30 an end obtained when the body posture angular acceleration p is 
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changed t.o generate the body inclination restoring moment 
ZMP-converted value (ZMPrec) pattern as described above will be 
determined by adding the second order integration of 
( ZMPrec^ Fz /AMp ) from time TstoTeto the horizontal body position 
5 at an end obtained when the body inclination restoring moment 
ZMP-converted value (ZME-rec) pattern is not generated, i.e., the 
end value of the horizontal body position determined in S414. 
[0358] 

After completing the processing of S312, the processing 
10 proceeds to S314 wherein an antiphase arm swing restoring angular 
acceleration (parec) pattern is determined such that the 
antiphase arm swing angular velocities at a start and an end 
agree . 

[0359] 

\5 To be more specific, the antiphase arm swing restoring 

angular acceleration patterns are set to be trapezoidal, as shown 
in Fig. 47, and a trapezoidal height azcyc2 in the period from 
time Tm to Ts2 and a trapezoidal height azcycl in the period from 
time Tm2 to Te are set to be the same. The trapezoidal heights 

20 azcycl and azcyc2 are determined such that the sum of the 
integrated value of |3ar€^c from time Ts to Te and the integrated 
value of the above determined antiphase arm swing acceleration 
Pa fcr preventing the floor reaction force moment vertical 
component Mz from exceeding a permissible range becomes zero. 

25 The t2:apezoidal heights in the two periods do not have to be the 
same . 

[0360] 

Supplementally, a floor reaction force moment vertical 
component (Mazrec) generated by the antiphase arm swing 
30 restoring angular acceleration pattern determined as described 
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above is as shown in Fig. 48. Accordingly, as shown in Fig. 49, 
the floor reaction force moment vertical component generated by 
a motion of the robot, including an antiphase arm swing, will 
be eventually the sum of Fig. 32, Fig. 34, and Fig. 37, i.e., 

5 the sum of Fig. 33 and Fig. 37. In the period from time Tm to 
Ts2 and the period from time Tm2 to Te, trapezoidal restoring 
moments are added. These periods are set so as to provide a 
sufficiently wide permissible range; therefore, the floor 
reaction force moment vertical components generated by motions 

10 of the robot, including antiphase arm swings, do not exceed the 
permissible range . 
[ 0361 ] 

I'he processing then proceeds to S316 wherein an initial (time 
Ts) antiphase arm swing angle and an angular velocity of a normal 
15 gait are determined. 
[0362] 

To be more specific, the initial antiphase arm swing angular 
velocity is determined according to the following equation. 

10 3 6 3] 

20 Initial antiphase arm swing angular velocity 

= Reference initial antiphase arm swing angular velocity 
- (Antiphase arm swing angle when |3arec is 0 

+ Second order integration of parec pattern) /Tcyc 
... Equation 1030 
25 03 64] 

where in the above equation, the antiphase arm swing angle 
when parec is zero is the antiphase arm swing angle (the antiphase 
arm swing angle at time Te) determined in S416. The second order 
intecjration of f3arec refers to a second order integrated value 
30 of the antiphase arm swing restoring angular acceleration from 
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time ^.:'s to Te set as shown in Fig. 47. The desired turning angle 
of a normal gait should be the angle that the normal gait turns 
over one step (that is, two steps of the first turning gait and 
the second turning gait) . 
5 [0365] 

The initial antiphase arm swing angle is set to agree with 
the reference initial antiphase arm swing angle . Alternatively, 
based on a finally determined antiphase arm swing angular 
acceleration (that is, the above determined sum of antiphase arm 

10 swing acceleration (3a and the restoring angular acceleration 
parec for preventing the floor reaction force moment vertical 
component Mz from exceeding a permissible range) and the above 
determined initial antiphase arm swing angular velocity, the 
average value of the difference between an arm swing angle 

15 calculated when an initial antiphase arm swing angle is set to 
agree with a reference initial antiphase arm swing angle and a 
reference antiphase arm swing angle, or an average value of the 
maximum value and the minimum value of the difference may be 
determined, and then the value obtained by subtracting a half 

20 of the determined average value from the reference initial 
antiphase arm swing angle may be determined as the final initial 
antiphase arm swing angle. This arrangement makes it possible 
to prevent the absolute value of the difference between a 
calculated arm swing angle and the reference antiphase arm swing 

25 angle from becoming excessively large. 
[0366] 

One of the reasons that times Ts, Tm, Ts2, and Tm2 have been 
set as described above is to prevent the floor reaction force 
horizontal component Fx from exceeding the permissible range 
30 [Fxmin, Fxmax] even if the body posture angular acceleration p 
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is generated to set the body posture angular velocity back to 
the initial angular velocity of a reference body posture 
trajectory during the period from time Tm to Ts2 and the period 
from "ime Tm2 to Te . In other words, the floor reaction force 
5 horizontal component permissible range is sufficiently wide in 
the period from time Tm to Ts2 and the period from time Tm2 to 
Te, so that the floor reaction force horizontal component Fx does 
not exceed the permissible range even if the body posture angular 
acceleration |3 is generated to restore the body posture angular 
10 velocity, while satisfying the desired ZMP . 
[03 67] 

Another reason that the times Ts, Tm, Ts2, and Tm2 have been 
set as described above is to prevent the floor reaction force 
moment vertical component Mz from exceeding the permissible 

15 range [Mzmin, Mzmax] even if the antiphase arm swing angular 
acceleration pa is generated to set the antiphase arm swing 
angular velocity back to the initial angular velocity of a 
reference antiphase arm swing angle trajectory during the period 
from -:ime Tm to Ts2 and the period from time Tm2 to Te . In other 

20 words, the floor reaction force moment vertical component 
permissible range is sufficiently wide in the period from time 
Tm to Ts2 and the period from time Tm2 to Te, so that the floor 
reaction force moment vertical component Mz does not exceed the 
permissible range even if the antiphase arm swing angular 

25 acceleration (3a is generated to restore the antiphase arm swing 
angular velocity. 
[0368] 

After the processing of S316 of Fig. 20 is completed as 
described above, the processing proceeds to S210 of Fig. 19 
30 wherein the horizontal body position and velocity at the end of 
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a generated gait (provisional normal gait) are converted into 
values observed from a supporting leg coordinate system (the 
coordinate system of Y/" , Y'" , and Z'" shown in Fig. 28) 
associated with the supporting leg of that particular instant, 
and the values are defined as (Xe, Vxe) (Xe: Body horizontal 
position at the end; and Vxe: Body horizontal velocity at the 
end) . 

[ D369] 

Subsequently, the processing proceeds to S212 wherein the 
difference between the initial horizontal body position and 
velocity (Xs, Vxs) and the horizontal position and velocity at 
the end (Xe, Vxe) i s calculated , as illustrated . This difference 
(Xs-Xe, Vxs-Vxe) is refe5rred to as a horizontal body position 
and velocity boundary condition error (errx, errvx). In a normal 
gait, the boundary condition must be satisfied, so that (Xs, Vxs) 
and (Xe, Vxe) must agree. Hence, the horizontal body position 
and velocity boundary condition error (errx, errvx) must be zero 
or substantially zero . In the present embodiment, (Xs, Vxs) that 
sets the horizontal body position and velocity boundary 
condition error (errx, errvx) to substantially zero is 
explora tor i ly determined . 
[0370] 

Subsequently, the processing proceeds to S214 wherein it is 
determined whether the calculated horizontal body position and 
velocity boundary condition error (errx, errvx) falls within the 
permissible range appropriately set beforehand. Instead of 
setting the permissible range of a horizontal body position and 
velocity boundary condition error as described above, it may be 
determined whether the difference between an initial divergent 
component (Xs+Vxs/coO) and a divergent component at an end 
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(Xe+Vxe/coO) and the difference between an initial convergent 
component (Xs-Vxs /goO ' ) and a convergent component at an end 

(Xe-Vxe/ooO' ) respectively fall within certain permissible 
ranges. As previously mentioned, coO denotes a certain 
prede t€5rmined value. 
[0371] 

If the determination result of S214 is NO, then the 
processing proceeds to S216. In this S216, a plurality of (two 
in th€5 present embodiment) initial value candidates (Xs + AXs, 
Vxs) and (Xs, Vxs + AVxs) is determined in the vicinity of (Xs, 
Vxs) . Here, AXs and AVxs mean predetermined minute variation 
associated with Xs and Vxs, respectively. Then, taking each of 
these initial value candidates as an initial state of the 
horizontal body position and velocity, a normal gait is generated 
using a gait parameter by the same processing as that of the above 
3208. Further, the body position and velocity at the end of the 
generated normal gait are converted to obtain values (Xe+AXel, 
Vxe+AVxel) and (Xe+AXe2, Vxe+AVxe2) observed from a supporting 
leg coordinate system (the coordinate system of X'", Y"', and 
Z'" shown in Fig. 28) associated with the supporting leg at that 
particular instant. Here, (Xe+AXel, Vxe+AVxel) means the body 
pos i t:. on and velocity at an end that corresponds to (Xs + AXs, Vxs), 
and (Xe+AXe2, Vxe+AVxe2) corresponds to the body position and 
velocj-ty at an end that corresponds to (Xs, Vxs+AVxs) . In the 
processing for generating a normal gait (provisional gait) in 
this case, the initial state (the state at time Ts ) of a variable 
other than the horizontal body position and velocity may be set 
to the same value as that in a case where, for example, the initial 
value candidate of the horizontal body position and velocity is 
set to (Xs, Vxs) . In 8216, the same processing as that of the 
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above S21C) is carried out to determine the difference between 
each initial value candidate and the body position and velocity 
at an end corresponding thereto, i.e., the horizontal body 
position and velocity boundary condition error corresponding to 
5 each Initial value candidate (Xs+AXs, Vxs ) , (Xs, Vxs+AVxs). 
[ 3372 ] 

Next, the processing proceeds to S218 wherein, based on the 
horizontal body position and velocity boundary condition error 
corresponding to each of (Xs, Vxs) and the initial value 

10 candidates in the vicinity thereof (Xs + AXs, Vxs), (Xs, Vxs + AVxs), 
an initial value candidate following (Xs, Vxs) is determined by 
a searching method (a method in which a pseudo- Jacobian 
(sensitivity matrix) is determined and then a next candidate is 
determined by the steepest descent method or the like, or the 

15 simplex method or the like) , More specifically, a sensitivity 
matrix indicating a changing degree of a horizontal body position 
and velocity boundary condition error observed when a horizontal 
body position and a body horizontal velocity are respectively 
changed minutely from the initial value candidate (Xs, Vxs) on 

20 the basis of the horizontal body position and velocity boundary 
condi tion errors associated with each of (Xs, Vxs) and the initial 
value candidates in the vicinity thereof (Xs+AXs, Vxs), (Xs, 
Vxs+AVxs) is determined, and then, based on the determined 
sensitivity matrix, an initial value candidate (Xs, Vxs) that 

25 will further reduces the horizontal body position and velocity 
boundary condition error is newly determined. After the new 
initial value candidate (Xs, Vxs) of the hori zontal body pos i tion 
and velocity is determined as described above, the processing 
returns to S206. 

30 [037 3] 
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Tlie aforesaid processing (the processing from S206 to S218) 
IS ref>eated as long as the determination result of S214 is NO. 
In thj s case, in S300 (refer to Fig. 20) of the processing for 
generating a normal gait corresponding to a new initial value 
5 candiciate (Xs, Vxs) of the horizontal body position and velocity 
(S208" , the initial value of the body posture angular velocity 
is set t:o the value determined in S310 (refer to Fig. 20) in the 
processing of S208 that corresponds to the last time's initial 
value candidate (Xs, Vxs) of the horizontal body position and 

10 velocity rather than being set to the initial value of the 
reference body posture angular velocity. And if the 

determination result of S214 is YES, then the processing leaves 
the repetition loop (S204) and proceeds to S2 2 0 . The pr ovi s ional 
normal gait generated immediately before leaving the repetition 

15 loop of S204 will be obt^ained as the normal gait that satisfies 
the boundary condition. 
[0374 I 

In S220, an initial horizontal body position and velocity 
(XO, VO) at an original initial time 0 (the end time of the current 
20 time gait) , an initial vertical body position and velocity (ZO, 
VzO) at the original initial time 0, and initial body posture 
angle and angular velocity at the initial time 0 are determined. 
[0375] 

Specifically, (XO, VO) and (ZO, VzO) are determined to be 
25 the values obtained by converting the horizontal body 
posit -Lon/velocity and the vertical body position/ velocity, 
which are determined at the time of instant when a second turning 
gait 2.S switched to a first turning gait, i.e., at time k=Tcyc 
(time Te-Ts), into the values observed from the supporting leg 
30 coordinate system (the X'" , Y"' , and Z"' coordinate system of 
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Fig. 28) associated with the supporting leg of the first step 
start:^ng from time Tcyc (i.e., a second 1st turning gait) in a 
case where a gait is generated to satisfy a gait condition on 
the basis of a body inclination restoring moment ZMP-converted 
5 value pattern and the initial body posture angle and angular 
velocity of a normal gait at time Ts that have been determined 
in S310 and the horizontal body position and velocity (Xs, Vxs) 
at time Ts after leaving the loop of S204 . Similarly, the initial 
state posture angle and angular velocity are determined to be 

10 the values obtained by converting the body posture angle and 
angular acceleration determined when time k=Tcyc (time Te-Ts) 
into values observed from the supporting leg coordinate system 
(the y/" , Y"', and Z'" coordinate system of Fig. 28) associated 
with the supporting leg of one step starting from time Tcyc (i.e., 

15 a second first turning gait) . 
[ 0 3 7 6 .1 

Subsequently, the p>rocessing proceeds to S222 wherein a 
normal gait initial divergent component q[0] is determined 

accortiing to the following equation. 
20 [0377] 

q[0] - XO + VO/goO... Equation 40 
[ D378 1 

where coO takes a certain predetermined value, as explained 
above in relation to the divergence. 

25 [0379] 

Subsequently, the processing proceeds to S224 wherein the 
normal gait initial divergent component q[0] is converted into 
a value observed from a current time's gait supporting leg 
coordinate system, and this is determined as q"[0]. Further, 
30 the initial vertical body position and velocity (ZO, VzO) is 

- 168 - 



converted into a value observed from the current time' s gait 
supporting leg coordinate system, and this is determined as (ZO", 
VzO") . 

[ (] 3 8 0 ] 

5 Supplementally, (ZO", VzO") agrees with the vertical body 

positjLon and velocity at the end of a second turning gait observed 
from the supporting leg coordinate system of the second turning 
gait (the X", Y'', and Z'' coordinate system of Fig. 15) . In 
addition, q''[0] also agrees with the divergent component at the 

10 end ot the second turning gait observed from the supporting leg 
coordinate system of the second turning gait (the X" , X" , and 
coordinate system of Fig. 15). Alternatively, therefore, 
(ZO", VzO'') and q'' [ 0 ] may be calculated by utilizing these 
properties . 

15 [0381] 

The processing further proceeds to S226 wherein initial 
antiphase arm swing angle and angular velocity (GazO, coazO) at 
Che original initial time 0 (the end time of the current time 
qait) are determined, and further, (GazC, GoazO"), which is the 

20 value observed from the current time's gait supporting leg 
coordinate system is determined. To be more specific, (GazO, 
coazO) is determined to be the value obtained by converting the 
antiphase arm swing angle and angular velocity, which are 
determined at the time of instant when a second turning gait is 

25 switched to a first turning gait, i.e., at time k=Tcyc (time 
Te-Ts) , in a case where a gait is generated to satisfy a gait 
condit.ion on the basis of an antiphase arm swing restoring angular 
accelerati on pattern, and initial (time Ts ) antiphase arm swing 
cmgle and angular velocity of a normal gait that have been 

30 determined in S314 and S316 (more specifically, in a case where 
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an antiphase arm swing angle trajectory is determined such that 
a floor reaction force moment vertical component does not exceed 
a perrr.issible range in a period other than the body posture angle 
and antiphase arm swing angle restoring period, and the antiphase 
5 arm saving angle trajectory is determined such that the sum of 
the reference antiphase arm swing angular acceleration paref and 
the ar.tiphase arm swing restoring angular acceleration |3arec is 
generated in the body posture angle and antiphase arm swing angle 
restoring period) , into a value observed from the supporting leg 
10 coordinate system (the X'", X" ' , and Z'" coordinate system of 
Fig. 2 8) associated with the supporting leg of one step starting 
from -ime Tcyc (i.e., a second 1st turning gait). 
[ 3 3 8 2 J 

Tnus, the processing of S024 of Fig. 12, that is, the 
15 subroutine processing for determining an initial state of a 
normal gait is finished. 

[3383] 

Subsequently, the processing proceeds to S026 of Fig. 12 
wherein the gait parameters of the current time gait are 
20 determined (some are provisionally determined) . To be more 
specific, in S026, the following processing is carried out 
according to the flowchart shown in Fig. 29. 
[0384 ] 

First, in S600, the foot traj ectory parameter s of the current 
25 time gait are set such that the foot position/posture trajectory 

of th6? current time gait continues to the foot position/posture 
trajectory of a normal gait. 
[0385] 

Specifically, the free leg foot position/posture at the 
30 start of the current time gait (the initial value of the free 
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leg foot position/posture of the current time gait) is set to 
current free leg position/posture observed from the current 
time's gait supporting leg coordinate system (the free leg 
position/posture at the end of the last time's gait). The 
5 supporting leg foot position/posture at the start of the current 
time gait ( the initial va Lue of the current time' s gait supporting 
leg foot position/posture) are set to current supporting leg foot 
position/posture observed from the current time's gait 
supporting leg coordinate system (the supporting leg foot 
10 position/posture at the end of the last time's gait) . The free 
leg foot position/posture at the end of the current time gait 
is de^iermxned on the basis of a next time's gait supporting leg 
coordinate system observed from the current time's gait 
supporting leg coordinate system (a required value of the free 
15 leg landing position/posture of the first step related to the 
current time gait) . More specifically, the free leg foot 
position/posture at the end of the current time gait are 
determined such that a representative point of a free leg foot 
22 agrees with the origin of the next time's gait supporting leg 
20 coordinate system observed from the current time's gait 
supporting leg coordinate system when the free leg foot 22 is 
turned, from the free leg foot position/posture at the end of 
the current time gait, until substantially the entire surface 
of the sole of the foot 22 comes in contact with the ground without 
25 slippage, while maintaining the free leg foot 22 in contact with 
a floor . 

[0386] 

At the end of the current time gait, the supporting leg foot 
22 is off the floor and floating. To determine the trajectory 
30 after the supporting leg foot 22 leaves the floor, an expected 

- 171 - 



supporting leg foot landing position/posture is set. The 
expec!ied supporting leg foot landing position/posture is set on 
the basis of the next but one time's gait supporting leg 
coordinate system observed from the current time's gait 
5 supporting leg coordinate system (a required value of the free 
leg foot position/posture of the second step related to the 
current time gait) . To be more specific, the expected supporting 
leg foot landing position/posture is determined such that a 
representative point of the foot 22 obtained when the foot 22 

10 is turned from that position/posture without slippage until 
substantially entire surface of the sole of the foot 22 is brought 
into contact with the floor while holding the foot 22 in contact 
with the floor agrees with the origin of the next but one time's 
gait supporting leg coordinate system observed from the current 

15 time's gait supporting leg coordinate system. 
[0387] 

The supporting leg foot position/posture at the end of the 
current time gait is determined by generating a foot 
position/posture trajectory from a current supporting leg 

20 position/posture (the supporting leg foot position/posture at 
the start of the current time gait) to the expected foot landing 
position/posture corresponding to the next time' s gait 
supporting leg coordinate system (the required value of the free 
leg foot landing position/posture of the second step in the 

25 aforesaid required parameter) by using the finite-duration 
setting filter until the end of the current time gait. 
[0388] 

Subsequently, the processing proceeds to S602 wherein the 
reference body posture trajectory parameter of the current time 
30 gait is determined in the same manner as that for the first turning 
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gait and the second turning gait of a normal gait. The aforesaid 
parameter, however, is set such that the reference body posture 
trajectory of the current time gait continuously connects to the 
reference body posture trajectory of the above normal gait (such 
5 that the reference body posture angle and the angular velocity 
at the end of the current time gait agree with the reference body 
posture angle and the angular velocity, respectively, at the 
start of a normal gait) . In the present embodiment, the 
reference body posture related to an inclination angle refers 
10 to a steady vertical posture in both a current time gait and a 
normal gait. 
[0389] 

Next, the processing proceeds to S604 wherein the reference 
arm posture trajectory parameters of the current time gait are 

15 determined in the same manner as that for the firs turning gait 
and the second turning gait of the normal gait. The above 
parameters, however, are set such that the reference arm posture 
at the start of the current time gait and the changing rate thereof 
agree with the current instantaneous values of a reference arm 

20 posture and the changing rate thereof, and the arm posture 
trajectory of the current time gait continuously connects with 
the arm posture trajectory of the normal gait. For the arm 
posture trajectory parameters determined here, the parameters 
related to, for example, a total center~of -gravity position of 

25 both arms, a lateral interval between right and left hands, and 
an antiphase arm swing angle are determined, as in the case where 
the normal gait parameters are determined (S104 in Fig. 14) . In 
the present embodiment, the total center-of -gravity position of 
both arms is set so as to be maintained at a constant level with 

30 respect to the body. 
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[ 03 90 I 

Tlie processing then proceeds to S606 wherein the floor 
t:eact:-on force vertical component trajectory parameters of the 
current time gait are determined such that the floor reaction 
force vertical component trajectory defined by the parameters 
will l:)e a substantially continuous {values are not jumping in 
steps) trajectory as illustrated in Fig. 3 mentioned above, as 
:.n the case of the first turning gait and the second turning gait 
of a normal gait. 

[0391] 

The floor reaction force vertical component trajectory 
parameters, however, are determined such that both the total 

center -of -gravity vertical position and velocity and the floor 
reaction force vertical component trajectory of the current time 
gait continuously connect with the normal gait. 
[C392] 

To be specific, first, the value (ZO", VzO") obtained by 
converting the vertical body position and velocity at the start 
of the normal gait that has been finally determined by the 
processing of S024 of Fig. 12 mentioned above (the processing 
for determining the initial state of the normal gait) into the 
value observed from a current time's gait supporting leg 
coordinate system, i.e., the total center-of -gravity vertical 
position and velocity at the start of the normal gait observed 
from the current time's gait supporting leg coordinate system 
are de::ermined using, for example, the above Equation 04 (or a 
kinematics model of the robot 1) on the basis of (ZO", VzC) or 
the like determined in S224 of Fig. 19. To be more specific, 
the to-al center-of -gravity vertical position at the start of 
the normal gait observed from the current time's gait supporting 
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leg ccordinate system is determined by substituting the body mass 
point vertical position of the model shown in Fig. 10, which 
corresponds to the vertical body position ZO" of the normal gait 
determined in S224, and the leg mass point vertical positions 
of a supporting leg and a free leg, which correspond to the values 
obtained by converting individual foot positions at the start 
of thc^ normal gait into the values observed from the current 
time's gait supporting leg coordinate system, into Equation 04, 
Further, the total center-of -gravity vertical velocity at the 
start of the normal gait observed from the current time's gait 
suppoiting leg coordinate system is determined by substituting 
the body mass point vertical velocity of the model shown in Fig. 
10, which corresponds to the body vertical velocity VzO" of the 
norma.] gait determined in S224, and the leg mass point vertical 
velocities of a supporting leg and a free leg, which correspond 
t.o the values obtained by converting individual foot vertical 
velocities at the start of the normal gait into the values 
observed from the current time's gait supporting leg coordinate 
systerr, into an equation derived from differentiating both sides 
of Equation 04. Alternatively, the initial total 

center-of -gravity vertical position and velocity may be 
calculated by using a more precise model. 
[0393] 

Then, the initial total center-of -gravity vertical position 
and velocity of the normal gait determined as described above 
is substituted into the terminal total center-of -gravi ty 
vertical positions and velocities of the following equations 13 
and 41, and the total cent er-of -gravi ty vertical position and 
velocity of the last time's desired gait instantaneous value {to 
be more precise, the value obtained by converting the terminal 
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state of the last time's desired gait into the current time's 
supporting leg coordinate system) into the initial total 
center-of -gravity vertical positions and velocities of 
Equations 13 and 41. A floor reaction force vertical component 
pattern (to be more specific, a parameter value) of the current 
time (jait is determined such that the relationship between 
Equations 13 and 41 is satisfied. The integrated values in 
Equations 13 and 41 are to be the integrated values in the period 
from the start to the end of the current time gait. 
[0394] 

Terminal total center-of -gravity vertical velocity - Initial 
total center-of -gravity vertical velocity 

- Firs-.t order integration of (Floor reaction force vertical 
component / Total mass of the robot) 

First order integration of acceleration of gravity 
... E]quation 41 
[0395] 

where the acceleration of gravity takes a negative value. 

[0396] 

To be more specific, first, at least two parameters out of 
the floor reaction force vertical component parameters (e.g., 
times of break points) that define the floor reaction force 
vertical component pattern as shown in Fig. 3 are taken as 
independent unknown variables. The values of the unknown 
variables are determined by solving a simultaneous equation 
composed of Equations 13 and 41. 

[ 0 397 ] 

The floor reaction force vertical component parameters to 
be selected as the unknown variables may be, for example, the 
height (the peak value of the floor reaction force vertical 
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component' and the width (duration of single stance period) of 
the trapezoid shown in Fig. 3. In this case, the slopes of both 
sides of the trapezoid shown in Fig. 3 take values determined 
beforehand on the basis of a current time gait cycle or the like, 
or the values of times of the break points of the floor reaction 
force vertical component pattern, excluding the time at which 
a single stance period is switched to a floating period, that 
lias be;en determined beforehand on the basis of a current time 
gait c:ycle or the like. Supplementally, if only one unknown 
variak)le is given, then no solution generally exists that 
satisiies the simultaneous equation of Equations 13 and 41. 
[0398] 

Subsequently, the processing proceeds to S608 wherein a 
floor reaction force horizontal component permissible range 
I. Fxmir, Fxmax] (to be more specific, the parameters defining the 
pattern of the floor reaction force horizontal component 
permissible range) is set in the same manner as that for the first 
turning gait and the second turning gait of a normal gait. For 
instance, the floor reaction force horizontal component 
permissible range is set according to the pattern shown in Fig. 
30. In the present embodiment, the floor reaction force 
horizontal component permissible range is set according to the 
aforesaid Equation 12 on the basis of the floor reaction force 
vertical component pattern determined previously in S606. 

[0399] 

Then, the processing proceeds to S610 wherein a floor 
reaction force moment vertical component permissible range 
[Mzmin, Mzmax] (to be more specific, the parameters defining the 
pattern of the floor reaction force moment vertical component 
permissible range) is set in the same manner as that for the first 
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turniiig gait and the second turning gait of a normal gait. For 
inst£i]ice, the floor reaction force moment vertical component 
permissible range is set according to the pattern shown in Fig. 
50. In the present embodiment, the floor reaction force moment 
vertical component permissible range is set according to the 
aforesaid Equation 1012 on the basis of the floor reaction force 
vertical component pattern determined previously in S606. 
[ (34 00] 

Subsequently, the processing proceeds to S612 wherein the 
ZMP trajectory of the current time gait (specifically, the 
parameters defining the ZMP trajectory, such as times and 
positions of break points of the trajectory) is set, as shown 
j.n Fig. 4, such that it exhibits a high stability margin and no 
sudden changes, as in the first turning gait and the second 
turning gait of a normal gait. The parameters are set such that 
the ZM? trajectory of the current time gait continuously connects 
with the ZMP trajectory of the aforesaid normal gait. In other 
words, the ZMP trajectory parameters are determined so that the 
ZMP position at the end of the current time gait agrees with the 
ZMP position at the start of the normal gait. In this case, in 
a running gait, the times and positions of break points of the 
ZMP trajectory in a single stance period may be set in the same 
manner as that for setting the ZMP trajectory parameters of the 
normal gait described above. And the ZMP trajectory parameters 
may be set so that a desired ZMP trajectory in a floating period 
linearly changes in succession from the start of the floating 
period to the ZMP position at the start of a normal gait. 

[0401] 

It should be noted that the ZMP trajectory parameters of the 
current time gait determined in S612 are merely temporary, and 
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will be corrected^ as it v/ill be discussed hereinafter. For this 
reason, the ZMP trajectory of the current time gait set as 
described above will be hereinafter referred to as a provisional 
desired ZMP trajectory of a current time gait. 

5 [04 02 1 

Lcistly, the processing proceeds to S614 wherein a body 
posta]:e angle and antiphase arm swing angle restoring period [Ta, 
TbJ is set. The body posture angle and antiphase arm swing angle 
restoring start time Ta corresponds to Tm in the second turning 
10 gait of a normal gait, while body posture angle and antiphase 
arm swing angle restoring end time Tb corresponds to Ts2 in the 
seconci turning gait of the normal gait. These times Ta and Tb 
are se^t in the same manner as that for setting Tm and Ts2 . 
[0403 j 

15 Reeturning to the explanation of Fig. 12, after carrying out 

the processing shown in S026 (the processing for determining the 
gait f)arameters of the current time gait) as described above, 
the pi'ogram proceeds to S028 wherein the gait parameters (ZMP 
trajec:tory parameters) of the current time gait are corrected, 

20 and the parameter of the antiphase arm swing angle is determined. 
In this processing, the ZMP trajectory parameters are corrected 
so as to make the body position/posture trajectory continue or 
approximate to a normal gait, and a parameter related to the 
antiphase arm swing angle of the current time gait is determined 

25 to make the antiphase arm swing angle converge to the antiphase 
^irm sv/ing angle trajectory of the normal gait. 
[04 04] 

F'j.g. 31 shows the subroutine flowchart illustrating the 
pr oces sing . 
^0 [0405] 
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F:.rst, the processing proceeds to S702 via S700 and 
tempoiar i ly generates a provisional current time gait until the 
time at which the current time gait ends on the basis of a 
provi^^ional desired ZMP pattern and other current time gait 
5 param€^ters . 

[04 06] 

In S702, the following processing will be carried out 
according to the flowchart shown in Fig. 32. 
[0407] 

10 Tlrie explanation will now be given. In S800, various elements 

are initialized. Specifically, zero is substituted into time 
k for generating a provisional gait. Furthermore, the initial 
state of the current time gait is obtained by converting the 
terminal state of the last time's desired gait (to be more 

15 speciiic, the end values of the gait states, including a 
horizontal body position and velocity, a vertical body position 
and velocity, a body posture angle and its angular velocity, a 
desire^d foot position/posture, and a desired arm posture) into 
£i current time's supporting leg coordinate system. 

20 [04 08] 

SLipplementally , the desired arm posture includes desired 
antiphiase arm swing angle and angular velocity- 
[04 09] 

Subsequently, the processing goes through S802 and proceeds 
25 to S804 wherein it is determined whether time k for generating 
a. provisional gait is before current time gait end time Tcurr 
(whether k < Tcurr) . If the determination result is YES, then 
the processing proceeds to a current time gait instantaneous 
value determining subroutine of 8806 to determine an 
30 instantaneous value of time k of the current time gait. In the 
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gait instantaneous value determining subroutine of S806, a 
provisional gait is generated as shown in Fig. 21. However, 
current time gait parameters are used in place of normal gait 
param(?ters, as the gait parameters, in the same manner as that 
5 of S3{)6 previously described. 
[ 0 4 10 1 

Subsequently, the processing proceeds to S808 to increment 
time k for generating a provisional gait by Ak, and then returns 
to S804. 
10 [04111 

If the determination result of S804 is NO, then the 
orocessing of the flowchart shown in Fig. 32 is completed. 

[0412] 

The processing discussed above generates the provisional 
15 current time gait from the start and the end thereof. 

[0413] 

Subsequently, the p>rocessing proceeds to 8704 wherein a 
terminal divergent component qO [ k] ( k=Tcurr ) is determined 

according to the equation shown in the figure (Equation 10 given 
20 above) from the horizontal body posi tion/velocity (Xe, Vxe) at 
the end of the current time gait determined in S702 as described 
above . 

[ 0414 ] 

Tne proceeding then proceeds to S706 wherein a terminal 
25 divergent component error errq, which is the difference between 
a current time gait end divergent component qO[k] and a normal 
gait i.nitial divergent component q'' (the one determined in S224 
of Fig. 19), is determined using the illustrated equation. 
Thereafter, the processing proceeds to S708 wherein it is 
30 determined whether the determined terminal divergent component 
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error errq falls within a permissible range (a range in the 
vicin:.ty of zero) . 
[ 0 4 1 5 J 

If the determination result of S708 is NO, then the 
5 processing proceeds to S710 wherein a = Aa (Aa being a 
predetermined extremely small amount) is set, and a provisional 
current time gait to the end thereof is calculated, as in the 
aforesaid S702, on the basis of the desired ZMP obtained by adding 
a trapezoidal correction to the current provisional desired ZMP 

10 pattern according to the relationship shown in Fig. 34. Here, 
referring to Fig. 34, ''a'' denotes the height of the trapezoidal 
pattern for correcting a provisional desired ZMP so as to make 
the current time gait terminal divergent component agree with 
the normal gait initial divergent component as much as possible 

15 {so as to approximate the horizontal body position/posture 
trajectory of the current time gait to the horizontal body 
position/posture trajectory of the normal gait) . In this case, 
in the present embodiment, the provisional desired ZMP is 
corrected during the period in which substantially the entire 

20 surface of the sole of the supporting leg foot 22 comes in contact 
with the ground (the enti re-sole-in-contact-with- the-ground 
period), that is, during the period in which the floor reaction 
force horizontal component permissible range is sufficiently 
wide, and the times of the break points of the above trapezoidal 

25 pattern are set to balance with the times of the break points 
of the provisional desired ZMP in the 

en t ire-sole -in-contact-with- the-ground period. The setting 
a = Aa is given in S710 to observe a change in the terminal divergent 
component error errq when the current provisional desired ZMP 

30 trajectory is corrected by an extremely small amount according 
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CO the- aforesaid trapezoidal pattern. 
[0416] 

After generating the provisional current time gait to the 
end with the provisional desired ZMP trajectory corrected using 
5 a=Aa in S710 as described above, the processing further proceeds 
ro S7:.2 wherein a terminal divergent component ql[k] in this 
provi ^3 ionail current time gait is determined according to the 
equat:.-on shown in the figure (the above Equation 10) on the basis 
of a horizontal body position/velocity (Xel, Vxel) at the end 
10 of the provisional current time gait determined in S710. 
[0417] 

In S710, Aa has been a constant of an extremely small amount 
appropriately set in the present embodiment. Alternatively, Aa 
may be^ set such that Aa decreases as the terminal divergent 

15 component error errq is decreased by repeated calculation, which 
will be explained below. However, even if it is set as a constant, 
it is f)Ossible to maintain the terminal divergent component error 
errq within a permissible range by performing a few repetitive 
ca leu] at ions . 

20 [04 18] 

Subsequently, the processing proceeds to S714 wherein a 
parameter sensitivity r (changing rate of the terminal divergent 
comporient error with respect to Aa ) is determined according to 
the equation shown in the figure. The processing further 

25 proceeds to S716 wherein the correction amount of the trapezoidal 
pattern having, as its height a, the value obtained by a = -errq/r, 
that is, the value obtained by dividing the terminal divergent 
component error errq determined in S706 by the parameters 
sensitivity r determined in S714, is added to the provisional 

30 desired ZMP pattern according to the relationship shown in Fig. 
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34, thereby correcting the provisional desired ZMP pattern (a 
new provisional desired ZMP pattern is determined) . 
[04191 

Then, the processing returns to S702. As long as the 
5 determination result of S708 is NO, the processing from S702 to 
3716 described above is repeated. When the determination result 

of S708 changes to YES, the processing leaves the repetition loop 
(S7 00 and moves forward to S718. 
[042 0 1 

10 In S718, the pattern of the body posture restoring moment 

ZMP-ccDnver ted value (ZMPrec) of the current time gait is 
determined primarily on the basis of the difference between a 
terminal body posture angle of the provisional current time gait 
and an initial body posture angle of a normal gait, and the 

15 difference between a terminal body posture angular velocity of 
the provisional current time gait and an initial body posture 
anguleir velocity of a normal gait such that the body posture angle 
trajec:tory of the current time gait approximates the body posture 
angle trajectory of the normal gait. The ZMPrec determined here 

20 is used for correcting a provisional desired ZMP so that the 
^agreement between the divergent component at the end of the 
c:;urrerit time gait and the divergent component at the start of 
the normal gait (the condition in S708) may be maintained even 
when a body posture angular acceleration is generated to connect 

25 (bring close) the body posture angle trajectory to the normal 
gait in the period, wherein the floor reaction force horizontal 
component permissible range becomes sufficiently wide (the 
period in a single stance period) , by the processing for 
generating a current time gait instantaneous value, which will 

30 be described hereinafter. 
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M.J421 i 

The^ ZMPrec exhibits a trapezoidal pattern similar to that 
explaiLned in relation to the processing for generating the normal 
gait. To be more precise, the ZMPrec is determined as follows. 
5 The ti apezoidal pattern of the ZMPrec of the current time gait 
is set: in the same manner as that for the trapezoidal pattern 
of th€^ ZMPrec in the period of the second turning gait shown in 
Pig. 26, the times (breakpoints) of apexes of the trapezoid being 
known (more specifically, the times of the break points of the 

10 trapezoid are balanced with the break point times of the desired 
ZMP) , and the height of the trapezoid (parameter) of the ZMPrec 
is determined as described below, taking the height of the 
trapezoid as an unknown number. In this case, the time at which 
the trapezoid pattern of the ZMPrec begins to rise is denoted 

15 oy Ta, and the time at which the trapezoid pattern returns to 
zero is denoted by Tb . 
[0422] 

Iz is usually impossible to continuously connect both body 
posture angle and body posture angular velocity to a normal gait 
20 at the; end of the current time gait if there is only one unknown 
parameter of the body posture restoring moment ZMP-converted 
value patt,ern. For this reason, in the present embodiment, an 
unknown parameter is determined so that the state of a gait 
generated gradually approximates the state of a normal gait over 
25 a pluccility of steps. 
[ D423 1 

S applementaliy, the ZMPrec pattern in a single gait may be 
complicated to produce two or more unknown parameters to 
continuously connect both the body posture angle and the body 
30 posture angular velocity to the normal gait at the end of the 
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current time gait. This, however, may lead to a ZMPrec pattern 
with excessive staggered variation. 
[04241 

Tne following will explain the principle of calculation and 
then the procedure of the calculation. 
[0425] 

As previously described, the difference between the terminal 
body posture angle of the provisional current time gait that has 
been determined with the height of the trapezoid of the ZMPrec 
pattern being zero in S702 as discussed above and the initial 
body posture angle of the normal gait is determined, and the 
determined difference is defined as Berr. Further, the 
difference between the terminal body posture angular velocity 
of the provisional current time gait and the initial body posture 
angular velocity of the normal gait is determined, and the 
determined difference is denoted by vBerr . 
[0426] 

Here, it is assumed that the current time gait is generated, 
defining the height of the trapezoid of the ZMPrec pattern as 
a certain value bcurr, and then the first turning gait is 
generated by the same algorithm as that of the current time gait. 
It -is assumed that the body posture restoring moment 
ZMP-converted value ZMPrec pattern of the first turning gait is 
basec on the sum of the ZMPrec pattern of the first turning gait 
(the trapezoidal pattern shown in Fig. 26, the height of which 
is acycl as mentioned above), determined in S310 of Fig. 20 and 
a ceitain value bl . 
[0427] 

The gait generated as described above is referred to as a 
ZMPrec corrected gait, and its end (the end of the first turning 
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qait) body posture angle and angular velocity are denoted by 01 
and vOl, respectively. 
[0428] 

The body posture angle and angular velocity at the end of 
the first turning gait are denoted by eiorg and vGlorg, 
respectively, of the original normal gait determined at the point 
when the subroutine processing for determining the initial state 
of the normal gait in S024 is completed (the normal gait in a 
case where the body posture angle and angular velocity at the 
start of the normal gait finally determined in S310 are taken 
as the initial values, and the ZMPrec pattern is the pattern 
determined in S310 (the trapezoidal pattern shown in Fig. 26, 
the height thereof being acycl)). 
[ 3429] 

Here, AGl and AvGl are defined as follows: 
[0430] 

AGl 01 - eiorg... Equation 50 
[0431] 

Avei = vGl ~ vBlorg... Equation 51 
[0432] 

AGl and AvGl mean the differences in body posture angle and 
angular velocity, respectively, between the corrected ZMPrec 
gait and the original normal gait at the point when these two 
gaits have been generated to the end of the first turning gait. 
If AGl and AvGl are zero, then the second turning gait generated 
according to the same algorithm as that of the current time gait, 
setting the height of the trapezoid of the ZMPrec pattern as acyc2, 
and following the corrected ZMPrec, will agree with the original 
normal gait . 
[0433] 
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Thus, the height bcurr of the trapezoid of the current time 
gai.t and the height bl of the trapezoid of the first turning gait 
at wh2.ch Aei and AvGl reach zero may be determined, and the 
determined bcurr may be taken as the finally determined height 
of the^ trapezoid of the current time gait. 
[ 04 34 J 

Tiie dynamic model related to the body posture angle of the 
robot 1 has the linear characteristic represented by flywheels 
FHx and FHy shown in Fig. 10. Hence, AGl and AvGl share the 
relatiLonships shown below with the height bcurr of the trapezoid 
of th€i current time gait, the height bl of the trapezoid of the 
first turning gait, the difference Berr between the terminal body 
posture angle of the provisional current time gait and the initial 
body posture angle of the normal gait, and the difference vGerr 
between the terminal body posture angular velocity of the 
provisional current time gait and the initial body posture 
angular velocity of the normal gait. 
[0435] 

A01 = cll^bcurr+cl2^bl + eerr + el^veerr... Equation 52 
[0436] 

AvGl - c21*bcurr + c22*bl + e2*v0err... Equation 53 
[ 0437 ] 

where cll, cl2, c21, c22, el, and e2 are coefficients 
uniquely determined primarily by the gait cycles of a current 
time gait and a first turning gait and the parameters 
(particularly the parameters related to time) of a body posture 
restoring moment ZMP-converted value ZMPrec pattern. 
[0438] 

Eased on the aforementioned principle, the calculation 
procedure first determines the body posture angle difference 

- 188- 



Gerr and the angular velocity difference V0err in the boundary 
between the provisional current time gait and the normal gait. 
[ C 4 3 9 ] 

Then, the coefficients cll, cl2, c21, c22, el, and e2 of 
5 Equations 52 and 53 are determined primarily on the basis of the 
gait cycles of a current time gait and a first turning gait and 
the parameters (particularly the parameters related to time) of 
a body posture restoring moment ZMP-conver ted value ZMPrec 
pattern . 
10 [ G 4 4 0 ] 

Next, the height bcurr of the trapezoid of the current time 
gait and the height bl of the trapezoid of the first turning gait 

are determined such that the right sides of Equations 52 and 53 
become zero. In other words, bcurr and bl are determined by 
15 solving the simultaneous equation having the left sides of 
Equation 52 and Equation 53 set to zero. 
[ C 4 4 1 ] 

Lastly, the height of the trapezoid of the trapezoidal 

pattern of the body posture restoring moment ZMP-conver ted value 
20 (ZMPrec) of the current time gait is set to the height bcurr of 
the trapezoid of the above determined current time gait. 
[ C 4 4 2 ] 

Subsequently, the processing proceeds to S720 wherein the 
pattern obtained by adding the body posture restoring moment 
25 ZMP-converted value pattern determined as described above in 

relation to S718 to the current provisional desired ZMP pattern 
(the provisional desired ZMP pattern when the processing leaves 
the repetition loop of S700) is determined as the desired ZMP 
pattern of the current time gait. This processing is the same 
30 as the processing for adding the trapezoidal pattern having the 
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height of l\a in S710 to the provisional desired ZMP pattern. 
[0443] 

The following will describe the reason for adding the body 
posture restoring moment ZMP-conver ted value pattern to the 
5 provisional desired ZMP pattern. 
[0444] 

The provisional current time gait generated in the loop of 
S700 is generated by setting the body posture restoring moment 
ZMP-converted value ZMPrec to zero (by setting the height 

10 parameter of the trapezoidal pattern of ZMPrec to zero) . In the 
provisional current time gait finally generated in the loop of 
S700, the body pos ition/ velocity continues to or approximates 
a normal gait, whereas the body posture angle deviates from the 
body posture angle of the normal gait and undesirably diverts 

15 in some cases. 
[0445] 

The body posture restoring moment ZMP-converted value 
pattern determined in S718 is used to generate a body posture 
angular acceleration for approximating a deviation of a body 

20 posture angle with respect to a normal gait to zero. 
[0446] 

If, however, a body posture angular acceleration based on 
the body posture restoring moment ZMP-converted value pattern 
determined in S718 is generated without correcting the 

25 provisional desired ZMP p)attern finally obtained in the loop of 
S700, then the horizontal body position trajectory has to be 
deviated from a horizontal body position trajectory of the above 
provisional current time gait in order to satisfy the dynamic 
balance condition (the moment in which the resultant force of 

30 the gravity and the inertial force of the robot acting on the 



- 190- 



desired ZMP, excluding a vertical component, is zero) . For this 
reason, in the present embodiment, the provisional desired ZMP 
pattern is corrected by ZMPrec in order to obviate the need for 
deviation of the horizontal body position trajectory from the 
5 one finally obtained in the loop of S700. 
[0447] 

If a body posture angular acceleration based on the body 
posture restoring moment ZMP-converted value pattern determined 
in S718 is generated in addition to the motion of the above 

iO provisional current time gait, then the ZMP (the point at which 
the moment of the resultant force of the gravity and the inertial 
force produced by a motion, excluding vertical component, 
reaches zero) deviates by the body posture restoring moment 
ZMP-ccnverted value. Conversely, therefore, by using the 

15 pattern, which is obtained by adding the body posture restoring 
moment ZMP-converted value pattern to a provisional desired ZMP 
pattern, as a desired ZMP pattern, the same body translational 
motior. as that of the above provisional current time gait can 
be obtained by generating the current time gait that satisfies 

20 the desired ZMP pattern V7hile generating a body posture angular 
accel6^ration of the body inclination mode based on the body 
posture restoring moment ZMP-converted value pattern determined 
in S718. 

[0448] 

25 The above is the reason why the pattern obtained by adding 

the body posture restoring moment ZMP-converted value pattern 
to the provisional desired ZMP pattern is used as the desired 
ZMP pattern. 
[ iD 4 4 9 1 

30 Subsequently, the processing proceeds to S722 wherein an 
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antipliase arm swing restoring angular acceleration pattern is 
determined such that the antiphase arm swing angle trajectory 
approximates to the antiphase arm swing angle trajectory of a 
normal gait on the basis of the difference between the terminal 
antiphase arm swing angle of the provisional current time gait 
and tl-ie initial antiphase arm swing angle of the normal gait and 
the di.f ference between the terminal antiphase arm swing angular 
velocity of the provisional current time gait and the initial 
antipnase arm swing angular velocity of the normal gait. The 
method for determining the pattern is almost the same as the 
method for determining the body posture restoring moment 
ZMP-converted value pattern in S718, except that variable names 
are different as shown below: 
[0450] 

Body posture restoring moment ZMP-converted value pattern -> 
Antiphase arm swing restoring angular acceleration pattern 
Horizontal component -> Moment vertical component 

[0451] 

^his will be explained in detail below. The antiphase arm 
swing restoring angular acceleration pattern is used in the 
processing for generating a current time gait instantaneous 
value, which will be discussed hereinafter, to make a correction 
so as to connect (approximate) the antiphase arm swing angle 
trajectory to the normal gait in the period wherein the floor 
reaction force moment vertical component permissible range 
becomes sufficient wide (a single stance period) . 
:04 52] 

^he antiphase arm swing restoring angular acceleration 
pattern is a trapezoidal pattern similar to that explained in 
relation to the processing for generating the normal gait. To 
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be more precise, the antiphase arm swing restoring angular 
acceleration pattern is determined as follows. The trapezoidal 
pattern of the antiphase arm swing restoring angular 
eiccelerati on of the current time gait is set in the same manner 
5 as that for the trapezoidal pattern of the antiphase arm swing 
restoring angular acceleration pattern in the period of the 
seconc. turning gait shown in Fig. 47, the times (break points) 
of apexes of the trapezoid being known (more specifically, the 
times of the break points of the trapezoid are matched to the 

10 break point times of the desired ZMP) , and the height of the 
trapezoid (parameter) of the antiphase arm swing restoring 
angular acceleration is determined as described below, taking 
the height of the trapezoid as an unknown number. In this case, 
the time at which the trapezoid pattern of the antiphase arm swing 

15 restoring angular acceleration begins to rise is denoted by Ta, 
and the time at which tho trapezoid pattern returns to zero is 
denoted by Tb . 
[C453] 

It is usually impossible to continuously connect both 
20 antiphase arm swing angle and antiphase arm swing angular 
velocity to a normal gait at the end of the current time gait 
if there is only one unknown parameter of the antiphase arm swing 
restoring angular acceleration pattern. For this reason, in the 
present embodiment, an unknown parameter is determined so that 
25 the state of a gait generated gradually approximates the state 
of a normal gait over a plurality of steps. 
[0454] 

Supplementally, the antiphase arm swing restoring angular 
acceleration pattern in a single gait may be complicated to 
30 produce two or more unknown parameters to continuously connect 
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both trie antiphase arm swing angle and antiphase arm swing angular 
velocity to the normal gait at the end of the current time gait. 
This, how€^ver, may lead to an antiphase arm swing restoring 
£mgul6r acceleration pattern with excessive staggered 
5 var ia t ion . 

[04 55] 

As previously described, the difference between the terminal 
antiphase arm swing angle of the provisional current time gait 
that has been determined with the height of the trapezoid of the 

10 antiphase arm swing restoring angular acceleration pattern set 
to zero in S702 as discussed above and the initial antiphase arm 
swing angle of the normal gait is determined, and the determined 
difference is defined as Gazerr. E'urther, the difference 
between the terminal antiphase arm swing angular velocity of the 

15 provisional current time gait and the initial antiphase arm swing 
angular velocity of the normal gait is determined, and the 
determined difference is denoted by v9zerr. 
[0456] 

Here, it is assumed that the current time gait is generated, 
20 defining the height of the trapezoid of the antiphase arm swing 
restoring singular acceleration pattern as a certain value bzcurr, 
and then the first turning gait is generated by the same algorithm 
as that of the current time gait. It is assumed that the 
antiphase arm swing restoring angular acceleration pattern of 
25 the first turning gait is based on the sum of the antiphase arm 
swing restoring angular acceleration pattern (the trapezoidal 
pattern shown in Fig. 47, the height of which is azcycl as 
mentioned above), determined in S314 of Fig. 20 and a certain 
value bz 1 . 
30 [0457] 
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The gait generated as described above is referred to as an 
antiphase arm swing restoring angular acceleration corrected 
gait, and its end (the end of the first turning gait) antiphase 
arm swing angle and angular velocity are denoted by Bzl and vGzl, 

respec:t iveily . 

[(M58 1 

The antiphase arm swing angle and angular velocity at the 
end of the first turning gait are denoted by Gzlorg and vBzlorg, 
respectively, of the original normal gait determined at the point 
when the subroutine processing for determining the initial state 
of the normal gait in S02 4 is completed (the normal gait in a 
case where the antiphase arm swing angle and angular velocity 
at the5 start of the normal gait finally determined in S314 are 
taken as the initial values, and the antiphase arm swing restoring 
angular acceleration pattern is the pattern determined in S314 
(the -rapezoidal pattern shown in Fig. 41, the height thereof 
being azcycl ) ) . 
[0459] 

Here, ABzl and AvGzl are defined as follows: 
[ 0460 ] 

Aezl ^ 9zl - ezlorg... Equation 1050 
[0461 ] 

AvGzl = vezl - vezlorg... Equation 1051 
[0462] 

AGzl and AvBzl mean the differences in antiphase arm swing 
angle and angular velocity, respectively, between the corrected 
antiphase arm swing restoring angular acceleration gait and the 
original normal gait at the point when these two gaits have been 
generated to the end of the first turning gait. If AGzl and AvSzl 
are zero, then the second turning gait generated according to 
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the sane algorithm as that of the current time gait, setting the 
height of the trapezoid of the antiphase arm swing restoring 
angular acceleration pattern as azcyc2, and following the 
corrected antiphase arm swing restoring angular acceleration 
5 qait, will agree with the original normal gait. 



Thius, the height bzcurr of the trapezoid of the current time 
gait and the height bzl of the trapezoid of the first turning 
qait at which ABzl and AvBzl reach zero may be determined, and 
10 the determined bzcurr may be taken as the finally determined 
height, of the trapezoid of the current time gait. 



The dynamic model related to the antiphase arm swing angle 
of the robot 1 has the linear characteristic represented by a 

15 flywheel FHaz shown in Fig. 10. Hence, AGzl and AvGzl share the 
relationships shown below with the height bzcurr of the trapezoid 
of the current time gait, the height bzl of the trapezoid of the 
first turning gait, the difference Bzerr between the terminal 
antiphiase arm swing angle of the provisional current time gait 

20 and the initial antiphase arm swing angle of the normal gait, 
cind the difference vGzerr between the terminal antiphase arm 
swing angular velocity of the provisional current time gait and 
the initial antiphase arm swing angular velocity of the normal 
gait . 

25 [0465] 



[0463] 



[0464] 




Equation 1052 



[0466] 



AvGzl = cz21*bzcurr+cz22*bzl+ez2*vezerr 



30 



Equation 1053 



- 196- 



[ C 4 67] 

where czll, czl2, cz21, cz22, ezl, and ez2 are coefficients 
uniquely determined primarily by the gait cycles of a current 
time gait and a first turning gait and the parameters 
5 (particularly the parameters related to time) of an antiphase 
arm suing restoring angular acceleration pattern. 
[0468] 

Based on the aforementioned principle, the calculation 
procecure first determines the antiphase arm swing angle 
10 difference 9zerr and the angular velocity difference VGzerr in 
the boundary between the provisional current time gait and the 
normal gait. 
[C^469] 

Then, the coefficients czll, czl2, cz21, cz22, ezl, and ez2 
15 of Equations 1052 and 1053 are determined primarily on the basis 
of the gait cycles of a current time gait and a first turning 
gait and the parameters (particularly the parameters related to 
time) of an antiphase arm swing restoring angular acceleration 
p a t: t: e r n . 
20 [C470] 

N€'Xt, the height bzcurr of the trapezoid of the current time 
qa.it and the height bzl of the trapezoid of the first turning 
gait are determined such that the right sides of Equations 1052 
aind 1053 become zero. In other words, bzcurr and bzl are 
25 determined by solving the simultaneous equation having the left 
sides of Equation 1052 and Equation 1053 set to zero. 
[ C 471 ] 

Lastly, the height of the trapezoid of the trapezoidal 
pattern of the antiphase arm swing restoring angular 
30 acceleration of the current time gait is set to the height bzcurr 
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of the trapezoid of the above determined current time gait, 
f C 4 '7 2 ] 

Returning to Fig. 12, after the current time gait parameters 
are corrected in S028 described above or if the determination 
5 result in S016 is NO, then the processing proceeds to S030 to 
aetermine a current time gait instantaneous value. 

[ C 4 7 3 ] 

In S030, the subroutine processing shown in Fig. 42 is 
carried out . 
iO [0474] 

The same processing as that from S400 to S411 of Fig. 21 is 
carried out from S1400 to S1411 of Fig. 42, and then the processing 
from SIOOO to S1018 of Fig. 33, which is a subroutine of S1412, 
is carried out. 
! 5 [0475] 

Tc be specific, first, in SIOOO, the value of the reference 
body ytiw angle at the current time is substituted into the desired 
body yaw angle. Further, the value of a reference arm posture 
at the current time is substituted into the desired arm posture, 
20 excluding the arm posture antiphase arm swing angle and the 
angular velocity. 
[0476] 

Then, the processing proceeds to S1002 wherein it is 
determined whether the current time is in the period of restoring 
25 a body posture angle and an antiphase arm swing angle {the period 
from time Ta to time Tb ) . The processing proceeds to S1004 if 

the determination result of S1002 is NO, or to S1006 if the 
determination result is YES. 
[0477] 

30 In S1004, the same processing as that for calculating the 
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body horizontal acceleration a, the body angular acceleration 
P, and the antiphase arm swing angular acceleration (Ba (from S504 
to S528) in a period other than the body inclination 
angle/antiphase arm swing angle restoring period is carried out. 
5 [0478] 

In the case where the processing proceeds to S1006, the body 
horizontal acceleration atmp, which is required to satisfy the 
current time (time k) desired ZMP if a motion of the body 
t ranslational mode is to be performed, is determined in S1006, 
10 [0479] 

Then, the processing proceeds to S1008 wherein the 
instantaneous value ZMPrec of a body inclination restoring 

moment ZMP-conver ted value pattern at the current time is 
calculated on the basis of the parameters related to the body 
15 inclination restoring moment ZMP-converted value pattern 
determined in S312. 
[ C' 4 8 0 ] 

The processing proceeds to SlOlO wherein an instantaneous 
value parec of the antiphase arm swing restoring angular 
20 acceleration pattern at the current time is calculated on the 
basis of the parameters related to the antiphase arm swing 
restoring angular acceleration pattern determined in S314. 
[0481] 

Subsequently, the processing proceeds to S1012 wherein the 
25 body angular acceleration (body inclination angular 

acceleration) p of the body inclination mode is determined 
according to the equation shown in the figure. 
[ C) 4 8 2 ] 

Subsequently, the processing proceeds to S1014 wherein the 
30 body horizontal acceleration ot is determined according to the 
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equation shown in the figure. 
[0483] 

Subsequently, the processing proceeds to S1016 wherein the 
sum of the instantaneous value parec of an antiphase arm swing 

5 restoring angular acceleration pattern calculated in SlOlO and 
a reference antiphase arm swing angular acceleration (3aref (a 
value obtained by subjecting a reference antiphase arm swing 
angle to second order differentiation) is substituted into a 
desired antiphase arm swing angular acceleration (Ba . 

10 [0484] 

Subsequently, the processing proceeds to S1018 wherein a 
floor reaction force horizontal component Fx when the body 

horizontal acceleration is a is determined. 
[0485] 

15 Subsequently, the processing proceeds to S1414 wherein the 

body horizontal acceleration and the body posture angular 
acceleration are integrated to calculate a body horizontal 
velocity and a body posture angular velocity. The calculated 

result IS further integrated to determine a horizontal body 
20 position and a body posture. 
[04 8 6] 

Subsequently, the processing proceeds to S1416 wherein the 
antipt-iase arm swing acceleration is integrated to calculate an 
antiphase arm swing angular velocity. The calculation result 
25 j_s further integrated to determine an antiphase arm swing angle. 

[ 0487 ] 

Thus, the processing of S030 of Fig. 12 is completed. 
[04 88] 

Subsequently, the processing proceeds to 3032 wherein time 
30 t for generating a gait is incremented by At, and returns to S014 
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to continue to generate gaits as described above. 
[0489] 

The above is the processing for generating desired gaits in 
the gait generator 100. 

[04901 

The operation of the gait generator 100 according to the 
present embodiment will be further explained with reference to 
Fig. 4. In the gait generator 100, a desired gait is generated 
as described above. In the generated desired gait, a desired 
body position posture (trajectory) and a desired arm posture 
(trajectory) are sent out to a robot geometric model (an inverse 
kinematics calculator) 102. 
[0491] 

A desired foot position/posture (trajectory), a desired ZMP 
trajectory (desired total floor reaction force central point 
trajectory), and a desired total floor reaction force 
(trajectory) (a desired floor reaction force horizontal 
component and a desired floor reaction force vertical component) 
are sent to a composite-compliance operation determiner 104 and 
also to a desired floor reaction force distributor 106. In the 
desired floor reaction force distributor 106, the floor reaction 
force is distributed to the feet 22R and 22L, and a desired floor 
reaction force central point of each foot and a desired floor 
reaction force of each foot are determined. The determined 
desired floor reaction force central point of each foot and the 
desired floor reaction force of each foot are sent to the 
composite-compliance operation determiner 104. 
[04 92] 

A corrected desired foot position/posture (trajectory) with 
deformation compensation is sent from the composite-compliance 
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opera-ion determiner 104 to the robot geometric model 102. Upon 
receipt of the desired body position/posture (trajectory) and 
the corrected desired foot position/posture (trajectory) with 
deformation compensation, the robot geometric model 102 
5 calculates joint displacement commands (values) of twelve j oints 
(lOR(L), etc.) of the legs 2, 2 that satisfy them and sends the 
calculated commands to a displacement controller 108. The 
displacement controller 108 performs follow-up control on the 
displacements of the twelve joints of the robot 1, using the joint 
10 displacement commands (values) calculated by the robot geometric 
model 102 as desired values. In addition, the robot geometric 
model 102 calculates arm joint displacement commands (values) 
that satisfy the desired arm postures and sends the calculated 
commands to the displacement controller 108. The displacement 
15 controller 108 performs follow-up control on the displacements 
of the twelve joints of the arms of the robot 1, using the joint 
displacement commands (values) calculated by the robot geometric 
model 102 as desired values. 
[ 0493 ] 

20 A floor reaction force generated in the robot 1 (more 

specifically, an actual floor reaction force of each foot) is 
detected by a six-axis force sensor 34. The detected value is 
sent to the composite-compliance operation determiner 104. 
1.0494] 

25 In the actual body posture angular error (the difference 

between the desired body posture and an actual body posture 
occurred in the robot 1, posture inclination angle errors Gerrx 
and eerry (specifically, the error of the inclination angle of 
an actual body posture relative to the vertical direction with 

30 respect to the inclination angle of a desired body posture 
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relat:.vG to the vertical direction, a posture inclination angle 
error in the roll direction (about the X-axis) being Gerrx, and 
a posture inclination angle error in the pitch direction (about 
the Y-axis) being Gerry) is detected via a posture sensor 36, 
5 and the detected value is sent to a posture inclination 
stabi:.i zation control calculator 112. The posture inclination 
stabi j_i zat ion control calculator 112 calculates the horizontal 
component of a compensating total floor reaction force moment 
about a desired total floor reaction force central point (desired 
10 ZMP) for restoring the actual body inclination angle of the robot 
L to the desired body posture angle, and sends it to the 
composite-compliance operation determiner 104. 
[(J495] 

M(Dre specifically, in the present embodiment, a compensating 
15 total floor reaction force moment horizontal component Mdmdxy 
is determined according to the following equation by using, for 
example, PD control law: 
[ ID 4 9 6 ] 

Compensation total floor reaction force moment horizontal 
20 component Mdmdxy 

= K6b * Body posture rnclination angle error 

f Kcib ^ Body posture inclination angular velocity error 

d25 

[0497] 

25 The body posture inclination angular velocity error is a 

temporal differential value of the body posture inclination 
angle error, and means an error of an actual body posture 
inclination angular velocity with respect to a desired body 
postujre inclination angular velocity. The body posture 

30 inclination angle error is, more specifically, a vector composed 
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of a posture inclxnation angle error of the body 3 of the robot 
1 in the roll direction (about the X-axis) and a posture 
inclination angle error thereof in the pitch direction {about 
the Y-axis ) . 
[0498] 

Furthermore, a yaw angle error Gerrz in the above actual body 
posture angle error occurring in the robot 1 (more specifically, 
the posture angle error in the yaw direction (about the Z-axis) 
in the actual body posture angle error is Gerrz) is detected 
through the intermediary of the posture sensor 36, and the 
detected value is sent to a yaw stabilization control calculator 
113. The yaw stabilization control calculator 113 calculates 
the vertical component of the compensating total floor reaction 
force moment about a desired total floor reaction force central 
point (desired ZMP) for converging an actual body yaw angle and/or 
an angular velocity of the robot 1 to a desired body yaw angle 
and/cr an angular velocity, and sends it to the 
composite-compliance operation determiner 104. The 
compcsxte-compliance operation determiner 104 corrects the 
desired floor reaction force on the basis of the input value. 
Specifically, the desired floor reaction force is corrected such 
that the compensating total floor reaction force moment acts 
about the desired total floor reaction force central point 
(desired ZMP) . 
;0499] 

More specifically, in the present embodiment, a compensating 
total floor reaction force moment vertical component Mdmdz is 
dete2:mined according to the following equation by using, for 
example, the PD control law: 

[0500] 
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Compensat-Lon total floor reaction force moment vertical 
component Mdmdz = KSbz ^ Body yaw angle error 
+ Ko^bz ^ Body yaw angular velocity error 

d26 

[0501] 

The body yaw angular velocity error is a temporal 
differential value of the body yaw angle error, and means an error 
of an actual body yaw angular velocity with respect to a desired 
body yaw angular velocity. 
[0502] 

The composite-compliance operation determiner 104 corrects 
the desired floor reaction force on the basis of the input value. 
Specifically, the desired floor reaction force moment horizontal 
component is corrected such that the compensating total floor 
reaction force moment horizontal component acts about the 
desired total floor reaction force central point (desired ZMP) . 
In addition, the desired floor reaction force moment vertical 
component is corrected by adding the compensating total floor 
reaction force moment vertical component to the desired floor 
react.ion force vertical component about the desired total floor 
reaction force central point (desired ZMP) that dynamically 
balances with the desired gait. 
:0503] 

The composite-compliance operation determiner 104 
determines the aforesaid corrected desired foot 
position/posture (trajectory) with deformation compensation 
such that the state of the actual robot 1 and the floor reaction 
force calculated from sensor detection values or the like agree 
with the corrected desired floor reaction force. It is actually 
impossible, however, to make every state agree with a desired 
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states, so that a trade-off relationship is established 
thereoetween to make them compromi s ingly agree with each other 
as much as possible. More specifically, control errors with 
respect to desired values are weighted, and control is carried 
out to minimize the weighting average of control errors (or 
squares of control errors) . With this arrangement, the control 
IS conducted such that actual foot position/posture and a total 
floor reaction force almost follow desired foot position/posture 
and a desired total floor reaction force. 
[0504] 

The main point of the present invention is the generation 
of gaits of the robot 1 by the gait generator 100, and the 
construction and operation of the composite-compliance 
operation determiner 104 or the like described above are 
disclosed in detail primarily in Japanese Unexamined Patent 
Application Publication No. 11-300661 previously applied by the 
present applicant; therefore, no more explanation will be given. 
[0505] 

:;n S028 , as previously discussed, the current time gait 
parameters are corrected such that a terminal divergent 
component of the current time gait agrees with q" , which is a 
valu€^ obtained by observing an initial divergent component q [0] 
of a normal turning gait from the current time's gait supporting 
leg coordinate system. 

[0506] 

Actually, the divergent component is an indicator for 
assessing whether the horizontal body position of a generated 
gait converges to a normal turning gait when the gait is generated 
on the basis of current time gait parameters by using a dynamic 
model and the gait is repeatedly generated in succession on the 
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basis of normal turning gait parameters. Basically, the 
divergent component must be defined so that a terminal divergent 
component of the current time gait agrees with q", which is a 
value obtained by observing a normal turning initial divergent 
component q [0] from the current time's gait supporting leg 
coordinate systemat convergence. 
[0507] 

The divergent component defined by Equation 10 is actually 
a divergent component that approximately satisfies the aforesaid 
properties . 
[ 0508 ] 

Hence, in the present embodiment, it may be said that the 
current time gait parameters have been corrected so that the 
horizontal body position of a generated gait converges 
(approximates) to the horizontal body position of a normal 
turning gait when the gait is generated on the basis of current 
time gait parameters by using a dynamic model and the gait is 
repeatedly generated in succession on the basis of normal turning 
gait parameters. 
;0509] 

'::his is the same as that disclosed in Japanese Patent 
Appl:.cation No. 2000-352011. 
[0510] 

Especially in the present embodiment, the desired ZMP 
pattern of the gait parameters of the current time gait has been 
corrected so as to satisfy the condition (the current time gait 
approximating to the normal gait) . This will be explained with 
reference to Fig. 35. The trajectory indicated by reference mark 
B in the figure shows the horizontal body position trajectory 
generated so that divergent components agree at a gait boundary, 

-207- 



as described above. 
[0511] 

The trajectory indicated by reference mark A in the figure 
shows the horizontal body position trajectory obtained when a 
current time gait is generated so that horizontal body 
posit Lons/velocities at boundaries of normal turning gaits agree, 
and tnen a normal gait is repeatedly generated. 
[0512] 

AS shown in the figure, the trajectory indicated by reference 
mark B generally deviates from the trajectory indicated by 
reference mark A at the boundary of the current time gait and 
a first normal turning gait. Thereafter, however, the 
trajectory indicated by reference mark B gradually converges to 
(approximates) the trajectory indicated by reference mark A and 
substantially agrees with the trajectory indicated by reference 
mark A in the next normal turning gait period. Thus, the gait 
generating technique for making only the divergent components 
agree at a gait boundary also permits the prevention of gait 
divergence, as the gait generating technique for making both 
position and velocity agree at a gait boundary. The example 
indicated by reference mark C in the figure shows an example 
wherein a trajectory has been generated without considering them. 
In such a case, the generated trajectory diverges as time elapses . 
It is of course possible to complicate a desired ZMP pattern and 
a plurality of parameters is adjusted to make both position and 
velocity agree. This, however, may lead to a staggered desired 
ZMP pattern. Incidentally, if both position and velocity agree, 
then divergent components also agree, so that the method for 
making both position and velocity agree may be said to be a special 
example of the method for making divergent components agree. 



-208 



10513] 

E^ir thermore, in the present embodiment, it may be said that 
the current time gait parameters have been corrected so that the 
body posture angle of a generated gait converges (approximates) 

5 -o or agrees with the body posture angle of a normal turning gait 
when t:.he gait is generated on the basis of current time gait 
parameters by using a dynamic model and the gait is repeatedly 
generated in succession on the basis of normal turning gait 
parameters . 

10 [0514] 

In the present embodiment, for easier understanding, it has 
been arranged so that the floor reaction force horizontal 
component permissible range can be independently set for the 
longitudinal direction (X-axis direction) component and the 
15 lateral direction (Y-axis direction) component. More 
slippage-resistant gaits are generated by representing it by a 
relational expression of the longitudinal direction and the 
lateral direction . 
[0515] 

20 For instance, a so-called friction circle shown by the 

following equation may be used as a permissible range. 
[0516] 

(X component of floor reaction force horizontal component) * (X 
component of floor reaction force horizontal component) + (Y 
25 component of floor reaction force horizontal component) * (Y 

component of floor reaction force horizontal component) < { ka 

* y ^ Fz) ^ (ka ^ |i ^ Fz) 

. . Equation 59 
[0517] 

30 where Fz denotes a desired floor reaction force vertical 
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component, la denotes a frictional coefficient, and ka denotes 
a posi.tive constant of L or less. 
[0518] 

However, if the floor reaction force horizontal component 
permissible range is represented by the relational expression 
of the longitudinal direction and the lateral direction, as 
described above, then it is necessary to simultaneously or 
alternately determine a motion on a sagittal plane and a motion 
on a lateral plane so as to simultaneously or alternately satisfy 
the permissible range. 
[0519] 

A permissible range composed of a set of a floor reaction 
force horizontal component and a floor reaction force moment 
vertical component may be set instead of setting the floor 
reaction force horizontal component permissible range and the 
floor reaction force moment vertical component permissible range 
separately, as described above. As the floor reaction force 
horizontal component increases, the friction limit of a floor 
reaction force moment vertical component diminishes. Further, 
as the floor reaction force moment vertical component increases, 
the friction limit of the floor reaction force horizontal 
component diminishes. Taking this into account, therefore, 
setting a permissible range composed of the set of a floor 
reaction force horizontal component and a floor reaction force 
moment vertical component makes it possible to set a permissible 
range that is closer to an actual friction limit characteristic. 
Spec:.f ically, a permissible range may be set for a weighed average 
of an absolute value of a floor reaction force horizontal 
component and an absolute value of a floor reaction force moment 
vertical component. 
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[052 0] 

Since the sum of the total center-of -gravity vertical 
acceleration and the acceleration of gravity of the robot is 
proportional to the floor reaction force vertical component, 
parameters defining the trajectory of the total 
cente::-of-gravity vertical acceleration of the robot instead of 
the trajectory of the floor reaction force vertical component 
may be explicitly set as the gait parameters. They are 
substantially the same. Parameters defining a trajectory of 
vertical acceleration of a behaving portion of the robot close 
to the trajectory of the total center-of -gravity of the robot 
may be explicitly set as the gait parameters. For example, when 
the mass of the legs is sufficiently smaller than the mass of 
the body, the trajectory of vertical acceleration of the body 
and the trajectory of the total center-of -gravity vertical 
acceleration of the robot have substantially the same 
proportional relationship, it is acceptable to use the 
trajectory of vertical acceleration of the body to replace the 
trajectory of the floor reaction force vertical component. 
SimiJ.arly, the floor reaction force horizontal component is 
proportional to the total center-of-gravity horizontal 
acceleration of the robot, it is acceptable to use the total 
center-of-gravity horizontal acceleration of the robot and a 
permissible range thereof as a substitute for the floor reaction 
force horizontal component and the permissible range thereof in 
the present embodiment. Parameters defining a trajectory of 
horizontal acceleration of a behaving portion of the robot close 
to the horizontal trajectory of the total center-of-gravity of 
the robot may be explicitly set as the gait parameters. For 
example, when the mass of the legs is sufficiently smaller than 
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the mass of the body, the trajectory of horizontal acceleration 
of the body and the trajectory of the total center-of -gravity 
horizontal acceleration of the robot have substantially the same 
proportional relationship, it is acceptable to use the 
trajectory of vertical acceleration of the body to replace the 
crajectory of the floor reaction force vertical component. 
[0521J 

The floor reaction force moment about the desired ZMP and 
the vertical component of change rate of the total angular 
momentum of the robot about the desired ZMP are proportional, 
it is acceptable to use the vertical component of change rate 
of th€. total angular momentum of the robot and a permissible range 
thereof as a substitute for the floor reaction force moment 
vertical component and the permissible range thereof in the 
present embodiment . 
[0522] 

In the present embodiment, two motion modes , namely, the body 
inclination mode and the body translat ional mode, have been used 
to obtain proper values for the floor reaction force horizontal 
component and the floor reaction force moment horizontal 
component about a desire ZMP; however, motion modes other than 
these; may be used. 
;0523] 

For example, as shown in Fig. 36, when the body posture is 
turned with the hip joints being as the turning center, the 
angular momentum about the total center of gravity changes and 
the total center of gravity also changes. Overlapping 
(combining) this motion and the above-mentioned body 
translational mode at a predetermined ratio produces almost the 
same motion as that of the body inclination mode, and the floor 
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r:eact.Lon £orce horizontal component is no longer generated. 
Hence, if this is regarded again as the body inclination mode, 
then a similar gait can be generated according to the algorithm 
of the present embodiment. 
[0524] 

Thus, it is not required that one of the motion modes is a 
motion mode that does not produce a floor reaction force 
horizontal component. This is because any floor reaction force 
horizontal component and a floor reaction force moment about a 
desired ZMP can be generated as in the aforesaid example by any 
combination of modes as long as two motion modes having different 
generation ratios of a floor reaction force horizontal component 
and a floor reaction force moment about a desired ZMP are used. 
I 052b] 

A motion mode other than the motion mode that changes a body 
posture may be used. It is preferable, however, to select a 
motion mode that allows a large floor reaction force horizontal 
component or a floor reaction force moment about a desired ZMP 
to be generated in response to a minimized displacement. 
[0526] 

?or example, a motion mode for swinging the distal positions 
of r:-ght and left arms in the same direction, or a motion mode 
for perturbating the position of a foot not in contact with the 
ground (existing in the air) may be selected. However, when 
perturbating a free leg trajectory, the amount of perturbation 
should be return to virtually zero by the time immediately before 
landing so that a landing position will not change. 

[0527] 

Further alternatively, three or more motion modes may be 
used . 
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[0528 1 

In at least two of selected motion modes, the ratios of a 
floor reaction force horizontal component to a floor reaction 
force moment about a desired ZMP generated by the motion modes 
5 must oe different from each other. Otherwise, there will be 
usually no solution of a simultaneous equation (the behavior of 
each motion mode cannot be uniquely determined) . 
[0529] 

In addition, it is preferred to combine, as much as possible, 
10 a motion mode that allows a sufficiently large change to take 
place in a floor reaction force moment about a desired ZMP while 
minimizing the change of a floor reaction force horizontal 
component, and a motion mode that allows a sufficiently large 
change to take place in a floor reaction horizontal component 
15 while minimizing the change of a floor reaction force moment about 
a desired ZMP. 
[05301 

In other words, it is desirable to combine a motion mode that 
allows a sufficiently large change to take place in an angular 

20 momentum while minimizing the change of a total center of gravity, 
and a motion mode that allows a sufficiently large change to take 
place in a total center of gravity while minimizing the change 
of an angular momentum. This is because a displacement of a 
motion mode will be smaller. 

25 10531] 

Further, a body yaw rotation mode may be used in place of 
the antiphase arm swing mode to prevent a floor reaction force 
moment vertical component from exceeding a permissible range (to 
cancel a spinning force) . Alternatively, a motion mode may be 
30 used that displaces a part other than the arms and the body as 
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.Long as ic generates a floor reaction force moment vertical 
component. For example, a motion mode may be used that moves 
the distal ends of both legs in opposite longitudinal directions 
in a floating period. 
[3532 ] 

Alternatively, a few motion modes generating a floor 
reaction force moment vertical component may be used at the same 
time. For example, the antiphase arm swing mode and the body 
yaw rotation mode may be used at the same time. 
[0533] 

The body yaw rotation mode and the antiphase arm swing mode 
are the modes that generate a floor reaction force moment vertical 
component in such a manner that a total center-of-gravi ty 
position remains unchanged (in other words, without generating 
a floor reaction force horizontal component) . However, motions 
causing a total center-of -gravity position to change (in other 
words, motions that generate floor reaction force horizontal 
components) may be also used. This is because the floor reaction 
force- horizontal component can be adjusted by combining these 
modes with the body trans lational mode. 
;0534] 

::n addition to the dynamic model used in the aforesaid 
embodiment, the following models may be used. 

1 ) Non-linear model having mass points set at a plurality of links, 
as shown in Fig. 11 (multi-mass-point model) . 

2) Three-mass-point model disclosed in Japanese Patent 
Application No. 2000-352011 by the present applicant. 

3) Model that ignores the moment of an inertial force generated 
by the body yaw rotation mode or the antiphase arm swing mode. 

4) Separate type model that separately has a partial model 
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repre;>ent,ing a relationship between a resultant force of gravity 
and an inertial force (or a floor reaction force balancing 
therewith) and a body translational motion, and a partial model 
representing the above resultant force and a body posture 
rotational motion (a body inclination motion and a body yaw 
rotational motion) . For instance, the mass points shown in Fig. 
10 constitute a partial model representing the relationship 
between the above resultant force and the body translational 
motion, and the flywheels shown in Fig. 10 constitute a partial 
model representing the relationship between the above resultant 
force and a body posture rotational motion. 
[0535] 

The same model may be used for each processing or models may 
be properly used according to processing. For example, the 
aforementioned normal gait is generated merely to determine a 
terminal state of the current time gait, so that the dynamic 
accuracy required of the normal gait is lower than that required 
of the current time gait. Hence, for example, the processing 
for generating the current time gait may use the dynamic model 
shown in Fig. 10 (the model with 3 mass points + flywheels) , while 
the processing for generating a normal gait (particularly S408 
and S412 of Fig. 21) may generate a normal gait by using a dynamic 
model composed of a body mass point 3m corresponding to the body 
3 and flywheels FHx, FHy, FHaz, and FHbz (the model of one mass 
point + flywheels, which corresponds to the model of Fig. 10 from 
which leg mass points 2m and 2m have been removed) , ignoring the 
mass of each leg 2. The processing for generating the normal 
gait in this case may carry out the processing of S408 and S412 
of Fig. 21 with the mass of the leg mass point being set to zero 
in the aforesaid embodiment. This makes it possible to 
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dramatically reduce the calculation volume in the processing of 
generating normal gaits. 
[ 35361 

In the aforesaid embodiment, the block charts, the 
flowcnarts, and algorithms or the like may be subject to 
equivalent modifications, including modified calculation 
processing sequences. Furthermore, a low-pass filter may be 
inserted, as necessary. 
[0537] 

Although the aforesaid embodiment has been explained in 
conjunction with the bipedal mobile robot; however, it may be 
applied also to multi-legged robots having three or more feet. 

I 0538 ] 

Instead of using the techniques for determining the initial 
state of a normal gait (primarily an initial horizontal body 
position/velocity, and initial vertical body position/velocity 
and antiphase arm swing angle and angular velocity) by using 
exploratory techniques or partially using analyzing techniques, 
as ir. the aforesaid embodiment, diverse normal gait parameters 
may be calculated using the above techniques beforehand and the 
relationship between the normal gait parameters and the initial 
states of the normal gait may be mapped or processed into an 
approximate expression and stored so as to determine the initial 
values of the normal gait on the basis of the relationship, which 
has been mapped or formed into approximate expressions, at the 
time of actual travel. 
[0539] 

Further alternatively, a function that combines the 
aforesaid relationship, which has been mapped or processed into 
an approximate expression, and the aforesaid function f may be 
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pped or processed into an approximate expression and stored. 
More specifically, from the normal gait parameters composed of 
rhe a-oresaid foot trajectory parameters, the floor reaction 
force vertical component trajectory parameters, etc., the 
functions for directly determining the divergent components of 
normal gaits may be mapped or processed into approximate 
expressions and the results may be stored. For example, a normal 
gait may be generated in advance for each set of a plurality of 
types of typical normal gait parameters, the initial state of 
the normal gait for each set of normal gait parameters (to be 
determined in S024 of Fig. 12) may be determined beforehand, and 
a map that shows the relationship between the normal gait 
parameters of each set and the normal gait initial states may 
be prepared in advance. Then, when generating a desired gait, 
the initial state of a normal gait may be determined by selecting 
or interpolating from among the sets of the determined normal 
gait parameters on the basis of the aforesaid map. This 
arrangement obviates the need for generating a normal gait each 
time a current time gait is generated, thus permitting a 
sign.-ficant reduction in the amount of calculation for the 
proc(;ssing of generating a desired gait. 
[0540] 

As the method for correcting a current time gait to connect 
(approximate) it to a normal gait, the desired ZMP parameter of 
the c urrent time gait has been corrected in the present embodiment . 
However, other parameters may alternatively be corrected. 
[0541] 

For instance, the trajectory of a free leg in the air in a 
current time gait may be changed. If, for example, a horizontal 
body position is likely to shift farther to the rear than a normal 
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gait, then a free leg is promptly moved forward after it leaves 
a floor so as to shift the position of the center of gravity of 
the free leg toward the front. This causes the horizontal body 
position for satisfying a desired ZMP to be unavoidably further 
accelerated toward the front. As a result, the horizontal body 
posit:.on moves further forward at the end of the current time 
gart, makxng it possible to balance with the normal gait. 
[0542 I 

Instead of correcting a desired ZMP parameter, the cycle of 
current time gait may be corrected. For instance, if the 
horizontal body position is likely to shift farther backward than 
normal gait, then the cycle of the current time gait may be 
extended. Extending the cycle of the current time gait will 
extend the time for the horizontal body position to move, 
permitting extra forward movement to be accomplished 

accordingly . 
[0543] 

However, if a desired ZMP parameter is corrected when 
determining an appropriate value of the horizontal body position 
or the like by an exploratory technique, the horizontal body 
position at the end of the current time gait changes substantially 
proportionally to a correction amount of the desired ZMP, so that 
the number of explorations of the appropriate value can be reduced . 
In comparison to this, correcting the center-of -gravity 
trajectory of a free leg or the cycle of a gait requires a greater 
number of explorations for the appropriate value, because the 
horizontal body position at the end of the current time gait 
changes considerably nonlinearly in response to the correction. 
[0544] 

In the present embodiment, the desired ZMP parameter of the 
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currer.t time gait has been corrected, as the method for correcting 
the current time gait to connect (approximate) it to the normal 
gait. This method may lead to an excessive correction amount 
(correction amount a shown in Fig. 34) of the desired ZMP 
parameter in some cases . For instance, if a request for an abrupt 
changeover from the gait of hopping at a spot to a high-speed 
crave:, (a request for running) is issued, then the desired ZMP 
parameter must be given an extremely large shift backward 
relative to an advancing direction in order to ensure connection 
(approximation) to a high-speed normal gait (normal gait for 
running) . In this case, as discussed above, gait parameters in 
addition to the desired ZMP parameter are preferably corrected. 
In this case, however, the request for such an abrupt acceleration 
itself is actually unreasonable, so that a required value itself 
may be corrected as an alternative. 
[0545] 

To correct the required value, for example, a normal gait 
satisfying the request (the required parameter) is determined, 
for the time being, according to the procedure shown in the 
present embodiment, and at the point when a current time gait 
parameter has been determined so that it connects to the normal 
gait, it is determined whether the safety margin for the desired 
ZMP trajectory of the current time gait has been unduly reduced. 
If the safety margin has reduced too much (if the desired ZMP 
has deviated from a so-called supporting polygon or the desired 
ZMP is positioned near an edge of the supporting polygon), then 
the lequest may be corrected. 
,0546] 

Alternatively, the permissible range of acceleration/ 
deceleration of a gait ( (Next time gait initial velocity - Current 
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time gait init.ial velocity) / Cycle of current time gait) is set 
beforehano, and at the point when a request (a required parameter 
related to a gait cycle) is received, the 

acceleration/deceleration based on the request is determined, 
and ir: the determined acceleration/deceleration exceeds the 
permissible range, then the request may be corrected so that it 
fails withiin the permissible range. 
[0547] 

Supplementally, if simple dynamic models as discussed above 
are used, the aforesaid AMp, AFp, AMr, AFr, AMaz, and AMbz may 
be analytically determined by dynamic calculation; however, if 
a general, more complicated dynamic model is used, then they may 
be determined as follows. A floor reaction force in a case where 
the body is accelerated by an extremely small amount by the body 
trans Lational mode or accelerated by an extremely small amount 
by the body inclination mode is determined, and then the 
difference between this determined floor reaction force and the 
floor reaction force obtained in a case where the body 3 is not 
accelerated is determined. Then, the difference is divided by 
the aoove extremely small amount. 
[ 0548 ] 

Alternatively, the average value of each of AMp, AFp, AMr, 
AFr, AMaz, AMbz, and AMp/AMr or the like in standard gaits may 
be determined in advance and may be used. AMp, AFp, AMr, AFr, 
AMaz, AMbz, and AMp/AMr vary according to a state (a posture and 
its changing rate) , so that the accuracy slightly deteriorates, 
as compared with a method in which they are determined for each 
state at each instant; however, the amount of calculation can 
be significantly reduced when models that are more complicated 
than the aforesaid models are used. 
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L C 5 4 9 ] 

The following method may be used as the method for 
determining the height bzcurr of the trapezoid of the antiphase 
arm swing restoring angular acceleration pattern of the current 
time gait . 

[Ci550] 

The antiphase arm swxng angle and the angular velocity at 
the end of the current time gait of the aforesaid gait with a 
corrected antiphase arm swing restoring angular acceleration 
(refer to the explanation of S722 of Fig. 31) are denoted by Gzcurr 
andvezcurr, respectively, and the differences between these and 
the antiphase arm swing angle and the angular velocity of a normal 
gait cire denoted by AGzcerr and AvGzcerr. 
[05511 

A discrete type state equation may be set up, in which a gait 
cycle is defined as an interval, the differences 0zerr and vGzerr 
between the antiphase arm swing angle and the angular velocity 
at the end of a provisional current time gait and the initial 
antiphase arm swing angle and the angular velocity of a normal 
gait denote a last time's state, bzcurr denotes an input, and 
AGzcerr and AvGzcerr denote a current state, and then a feedback 
rule may be determined using a modern control theory or the like 
so as to converge AGzcerr and AvGzcerr to zero. The determined 
feedback rule may be used to obtain bzcurr. 
[0552] 

Eased mainly on the difference between desired antiphase arm 
swing angle/angular velocity and reference antiphase arm swing 
angle/angular velocity at each instant, the value of the 
antiphase arm swing restoring angular acceleration parec at each 
instant may be determined by using a state feedback rule or the 
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like so as to converge the above difference to zero rather than 
using a trapezoidal pattern to determine the antiphase arm swing 
restoring angular acceleration parec of a current time gait 
and/or a normal gait. 

[ 0 5 53 ] 

Based on desired antiphase arm swing angle/angular velocity 
of a current time gait at each instant, the antiphase arm swing 
restoring angular acceleration (3arec at each instant may be 
determined by using a state feedback rule or the like such that 
these will approximate initial antiphase arm swing angle/angular 
velocity of a first turning gait rather than using a trapezoidal 
pattern to determine the antiphase arm swing restoring angular 
acceleration (Jarec of a current time gait and/or a normal gait. 
[0554] 

To generate a gait for traveling on a slope (when moving the 
robot 1 on a slant floor surface), the permissible range of the 
floor surface horizontal component of a translat ional floor 
reaction force (a component parallel to the floor surface) , that 
is, tae permissible range of fictional force, or the permissible 
range of the floor surface horizontal component of a total 
center-of-gravity acceleration (this is proportionate to a 
frictional force) may be set in place of a floor reaction force 
horizontal component permissible range or a total 
center-of-gravity acceleration horizontal component 
permissible range. A case, for example, where the permissible 
range of the floor surface horizontal component (frictional 
force) of a trans lat ional floor reaction force will be explained 
(this explanation applies also to a case where the permissible 
range of a floor surface horizontal component of total 
center-of-gravity acceleration is set) . The frictional force 
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is determined according to Equation 72 shown below if an 
inclination angle relative to the horizontal plane of a floor 
surface is defined as Gf (a slope down forward in the direction 
in which the robot 1 advances is defined as a positive slope) . 
Therefore, to generate a gait according to the same algorithm 
as that in the aforesaid embodiment, the Equation 72 may be used 
to convert a frictional force permissible range into a floor 
reaction force horizontal component permissible range thereby 
to set the floor reaction force horizontal component permissible 
range. In this case, a desired floor reaction force vertical 
component may be used as the floor reaction force vertical 
component of Equation 72. 
[ 0555 ] 

Frictional force = Floor reaction force horizontal component 
* cos(ef) - Floor reaction force vertical component * sin(ef) 

... Equation 72 
[ 0556] 

When generating a gait for traveling on a slope (when moving 
the robot 1 on an inclined floor surface) , a floor reaction force 
moment vertical component can be converted into a moment in the 
direction of the normal line of a floor surface frictional force 
by Equation 1072, so that the permissible range of the component 
in a rlloor surface normal line of a floor reaction force moment, 
i.e., the permissible range of the moment in the direction of 
the normal line of a floor surface frictional force, may be set 
in place of the permissible range of a floor reaction force moment 
vertical component. 
[0557] 

Moment in the direction of the normal line of floor surface 
frictional force = Vertical component of floor reaction force 
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moment * cos(ef) ... Equation 1072 
[0558] 

The parameters of a current time gait may be re-determined 
in the middle of the generation of a current gait, as disclosed 
,n Japanese Patent Application No. 2000-352011 by the present 
applicant, instead of determining them when a preceding gait is 
completed, as in the aforesaid embodiment. This allows an 
immediate response to be taken if a gait request changes, although 
it involves an increased calculation volume. 
[0559] 

If correction of a gait (re-determination of a current time 
gait parameter) xs not completed within a current control cycle, 
then an uncorrected gait or provisionally corrected gait (a gait 
in the middle of exploration, i.e., a gait that does not fully 
satisfy an exploration completion condition (a deviation of a 
gait Doundary condition being less than a permissible value)) 
is tentatively output, and a properly corrected 
(non-provxsional) gait may be output by the next control cycle 
or by a plurality of control cycles later . The corrected desired 
3 ZMP trajectory and desired floor reaction force vertical 
component trajectory are connected, and these do not suddenly 
change in a short time; therefore, the desired ZMP trajectory 
and the desired floor reaction force vertical component 
trajectory of the current time gait will hardly present a problem 
5 although they will be slightly staggered. 
[0560] 

A second embodiment according to the present invention will 
now be explained hereinafter . In the explanation of the present 
embodiment, like constituent parts or like functional parts as 
K) those in the first embodiment will be assigned like reference 
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numerals as those in the first embodiment, and the explanation 
thereof will be omitted. 
[C561] 

Ar outline of the aspects of the present embodiment will be 
5 explained. In the present embodiment, a desired gait is 
corrected in addition to manipulating a desired floor reaction 
force for compliance control in order to approximate an actual 
body posture angle error, which is the difference between a 
desired body posture angle and an actual body posture angle, 
10 and/or the changing rate thereof to zero. In particular, the 
vertical component of a floor reaction force moment about a 
desired ZMP that dynamically balances with a desired gait is also 
correc:ted on the basis of a yaw angle component and/or its angular 
veloci.ty out of an actual body posture error. 
15 [0562] 

A block diagram showing the functional construction of a 
control unit 26 in the present embodiment is shown in Fig. 52. 

[0563] 

In the present embodiment, the compensating total floor 
20 reaction force moment horizontal component Mdmdxy calculated in 
a post:ure inclination stabilization control calculator 112 is 
suppl:-ed to a compensating total floor reaction force moment 
horizontal component distributor 110. The compensating total 
floor reaction force moment horizontal component distributor 110 
25 divides the compensating total floor reaction force moment 
horizontal component Mdmdxy into a desired floor reaction force 
moment horizontal component for compliance control and a model 
manipulation floor reaction force moment horizontal component. 
In other words, based on an actual body posture inclination angle 
30 error, the desired floor reaction force moment horizontal 
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component for compliance control and a model manipulation floor 
reaction force moment horizontal component are determined by the 
posture inclination stabilization control calculator 112 and the 
compensating total floor reaction force moment horizontal 
component distributor 110. 
[0564] 

Specifically, in the compensating total floor reaction force 
moment horizontal component distributor 110, a model 
manipulation floor reaction force moment horizontal component 
is determined first according to the equation given below. 
Incidentally, a permissible range of the floor reaction force 
moment horizontal component is determined in the gait generator 
100, as will be discussed hereinafter. 

[0565] 

If Mdmdxy > Upper limit value of the permissible range of 
a floor reaction force moment horizontal component, then 

Model manipulation floor reaction force moment horizontal 
component = -Mdmdxy + Upper limit value of the permissible range 
of a floor reaction force moment horizontal component. 

If Mdmdxy < Lower limit value of the permissible range of 
a floor reaction force moment horizontal component, then 

Model manipulation floor reaction force moment horizontal 
component ^- -Mdmdxy + Lower limit value of the permissible range 
of a floor reaction force moment horizontal component. 

If the lower limit value of the permissible range of a floor 
reaction force moment horizontal component < Mdmdxy, and Mdmdxy 
< the upper limit value of the permissible range of a floor 
reaction force moment horizontal component, then 

Model manipulation floor reaction force moment horizontal 
component = 0 
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Equation d2 6 

[0566] 

Then, a desired floor reaction force moment horizontal 
component for compliance control is determined according to the 
following equation . 
[0567] 

Desired floor reaction force moment horizontal component for 
compliance control 

= Mdmdxy + Model manipulation floor reaction force moment 
hori zontal component 

Equation d27 

[0568] 

Accordingly, the floor reaction force moment horizontal 
components are determined such that the difference between the 
desired floor reaction force moment horizontal component for 
compliance control and the model manipulation floor reaction 
force moment horizontal component is equal to Mdmdxy, 
[ C' 5 6 9 ] 

A block diagram of the compensating total floor reaction 

force moment horizontal component distributor 110 that performs 
the aforesaid calculations is shown in Fig. 53. 
[057 0] 

Tfie compensating total floor reaction force moment vertical 
component Mdmdz is determined in the yaw stabilization control 
calculator 113. More specifically, the compensating total floor 
reaction force moment vertical component Mdmdz is determined 

according to the yaw angle error (yaw angle component of the body 
posture error) and/or the yaw angular velocity error by using 
the following equation. 
[0571] 
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Compensation total floor reaction force moment vertical 
component Mdmdz ^ KGbz ^ yaw angle error 
+ Kcobz * yaw angular velocity error 

d]026 

[0572] 

where KGbz and the yaw angle error are gains, KGbz is set 
to zer(^ if che purpose is merely to prevent a rotational slippage 
about the vertical axis or a vibration about the vertical axis 
between the feet and a floor. This is because an attempt to 
approximate also the body yaw angle error to zero tends to cause 
an increase in an actual floor reaction force moment vertical 
component . 

[0573] 

The determined compensating total floor reaction force 
moment vertical component Mdmdz is supplied to a model 
manipulation floor reaction force moment vertical component 
determiner 111. The model manipulation floor reaction force 
moment vertical component determiner 111 determines a model 
manipulation floor reaction force moment vertical component on 
the basis of the compensating total floor reaction force moment 
vertical component Mdmdz. In other words, the compensating 
total floor reaction force moment vertical component Mdmdz and 
the model manipulation floor reaction force moment vertical 
component are determined on the basis of a body yaw angle error 
by the yaw stabilization control calculator 113 and the model 
manipulation floor reaction force moment vertical component 
deterrr:iner 111. 

[C574] 

Specifically, in the model manipulation floor reaction force 
moment vertical component determiner 111, a model manipulation 
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floor reaction force moment vertical component xs determined 
according to the equation given below. Incidentally, the 
permissible range of the floor reaction force moment vertical 
component compensation amount is determined in the gait 
generator 100, as will be discussed hereinafter. 
[ 0575] 

If Mdmdz > upper limit value of the permissible range of a 
floor reaction force moment vertical component compensation 
amount, then 

Model manipulation floor reaction force moment vertical 
component = -Mdmdz + Upper limit value of the permissible range 
of a floor reaction force moment vertical component compensation 
amount . 

If Mdmdz < Lower limit value of the permissible range of a 
floor reaction force moment vertical component compensation 
amount, then 

Model manipulation floor reaction force moment vertical 
component = -Mdmdz + Lower limit value of the permissible range 
of a floor reaction force moment vertical component compensation 
amount . 

If the lower limit value of the permissible range of a floor 
reaction force moment vertical component compensation amount < 
Mdmdz, and Mdmdz < the upper limit value of the permissible range 
of a floor reaction force moment vertical component compensation 

amount, then 

Model manipulation floor reaction force moment vertical 

component = 0 

Equation d26b 

[0576] 

A block diagram of the compensating total floor reaction 
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force P.oment horizontal component distrxbutor 110 that performs 
the aforesaid calculations is shown in Fig. 54. 
[0577] 

The desired floor reaction force moment horizontal component 
for compliance control and the compensating total floor reaction 
force moment vertical component Mdmdz are sent to the 
composite-compliance operation determiner 104. 
[0578] 

The model manipulation floor reaction force moment 
horizontal component and vertical component are sent to the gait 
generator 100. 

[0579] 

In place of the compensating total floor reaction force 
moment vertical component Mdmdz, the sum of the compensating 
total floor reaction force moment vertical component Mdmdz and 
the model manipulation floor reaction force moment vertical 
component may be sent as a desired value for compliance control 
to the composite-compliance operation determiner 104. 
[0580] 

The composite-compliance operation determiner 104 corrects 
the desired foot position/posture such that an actual floor 
reaction force approximates the desired total floor reaction 
force corrected by adding a desired floor reaction force moment 
horizontal component for compliance control and the compensating 
total floor reaction force moment vertical component Mdmdz to 
a desired total floor reaction force generated by the gait 
generator 100, while making the motion of the robot 1 follow the 
motion of a desired gait generated by the gait generator 100, 

thereby determining a corrected desired foot position/posture 

(tra-jectory) with deformation compensation. 
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[0581] 

In this case, it is actually impossible to make every state 
of foot position/posture of the robot 1 and floor reaction force 
agree with a target, so that a trade-off relationship is provided 
between them to reach compromisingly closest possible agreement, 

as in the first embodiment. 
[0582] 

Although it will be discussed in more detail hereinafter, 
the gait generator 100 generates the motion of a desired gait 
(part:_cularly a body position/posture trajectory) by using a 
dynam:.c model so that the floor reaction force moment horizontal 
component about the desired ZMP determined by the gait generator 
100 becomes a model manipulation floor reaction force moment 
horizontal component. Furthermore, the gait generator 100 
corrects the motion of the desired gait (particularly an arm swing 
trajectory) such that a model manipulation floor reaction force 
moment vertical component is additionally generated in the 
desired floor reaction force moment vertical component about the 
desired total floor reaction force central point (the desired 
ZMP) that dynamically balances with the desired gait generated 

above . 

[ 0583 ] 

The functional construction of the control unit 60 other than 
the above is identical to that of the aforesaid embodiment. 

10584] 

hn operation of the gait generator 100 in a second embodiment 
will be explained in detail below in conjunction with Fig. 55 
showing its main flowchart. From S3010 to S3028, the same 
processing as that from SOlO to S028 is carried out. 
[0585] 
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SLLbsequently, the processing proceeds to S3030 wherein the 
parameters defining the permissible ranges of the floor reaction 
force moment horizontal component about a desired ZMP for 
compliance control and a floor reaction force moment vertical 
component compensation amount are determined. 
[0586] 

A value obtained by dividing the floor reaction force moment 
horizontal component by the floor reaction force vertical 
component represents the amount of deviation of a ZMP (the central 
point of a floor reaction force) from a desired ZMP. 
Alternatively, therefore, the permissible range of a floor 
reaction force moment horizontal component may be divided by a 
floor reaction force vertical component to set the parameter of 
the ZMP permissible range converted into a floor reaction force 
central point (the permissible range of a floor reaction force 
central point) . 
[0587] 

Supplementally, based on the parameters of the permissible 
range of a floor reaction force moment horizontal component for 
compliance control and the permissible range of a floor reaction 
force moment vertical component compensation amount that are 
determined in S3030, the instantaneous values of the permissible 
ranges will be determined in a subroutine for determining a 
current time gait instantaneous value, which will be discussed 
hereinafter, and the determined instantaneous values are used 
for tiie aforesaid processing in the aforesaid compensating total 
floor reaction force moment horizontal component distributor 110 
and model manipulation floor reaction force moment vertical 
compc-nent determiner 111. 
I 0588] 



■233 



Regarding the floor reaction force moment horizontal 
component permissible range, a method for setting a floor 
reaction force moment permissible range is described in detail 
in PCI' application PCT/ JP03/ 004 35 by the present applicant. 
Hence, no further explanation will be given in the present 
de script ion . 

[ C 5 8 9 ] 

The floor reaction force moment vertical component 
compensation amount for compliance control means the 
compensation amount of a floor reaction force moment vertical 
component that can be added to the floor reaction force moment 
generated by a motion of a desired gait if the desired gait with 
a floor reaction force moment vertical component limited to a 
floor reaction force moment vertical component permissible range 
for generating a gait is supposedly generated in the gait 
generator LOO. Hence, the permissible range of a floor reaction 
force moment vertical component compensation amount cannot be 
widely set unless the floor reaction force moment vertical 
component permissible range for generating a gait is set to be 
sufficiently narrower than an actual friction limit. 

[ C 590] 

The permissible range of a floor reaction force moment 
vertical component compensation amount for compliance control 
may be set to be similar to the floor reaction force moment 
vertical component permissible range for generating a gait. For 
a floating period of the running gait shown in the aforesaid Fig. 
5, the permissible range of a floor reaction force moment vertical 
component compensation amount for compliance control is set to 
a range having an upper limit value of zero and a lower limit 
value of zero. 
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[0 591] 

Re'turning to Fig. 55, after the parameters defining the 
permissible ranges of the floor reaction force moment horizontal 
component about the desired ZMP for compliance control and the 
5 permissible range of the floor reaction force moment vertical 
comporent compensation amount are determined in S3030 as 
described above, or if the determination result of S3016 is NO, 
then tne processing proceeds to S3032 wherein a current time gait 
instantaneous value is determined. In S3032, a current time gait 

10 instantaneous value is determined such that a model manipulation 
floor reaction force moment horizontal component determined 
accorc.ing to the above Equation d2 6 is generated about the desired 
ZMP. However, the current time gait instantaneous value is 
detern.ined such that the floor reaction force moment vertical 

15 component that balances with the current time gait does not exceed 
the permissible range of the floor reaction force moment vertical 
component . 
[C592] 

Specifically, gait instantaneous values are determined 
20 according to the flowcharts shown in Fig. 57 and Fig. 58. More 
specifically, in S3030, the processing from S3400 to S3411 of 
E'ig. 57 is executed. The processing from S3400 to S3411 is 
exactly the same as that from S1400 to S1411 of Fig. 42 mentioned 
above , 
25 [0593] 

Then, the processing proceeds to S3412 wherein the 
instantaneous values (the current time values at the current time 
t) of the floor reaction force moment horizontal component 
permissible range [Mxymin, Mxymax] and a floor reaction force 
30 moment vertical component compensation amount permissible range 
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IMzcmin, Mzcmax] at the current time are determined on the basis 
of the parameters of the floor reaction force moment horizontal 
component permissible range for compliance control and the floor 
reaction force moment v€Brtical component compensation amount 
permissible range that have been determined in S3030 of the 
aforesaid Fig. 55. 
[C594] 

The determined floor reaction force moment horizontal 
component permissible range is sent to the compensating total 
floor reaction force moment horizontal component distributor 110 
trefei to Fig. 52) . Then, the current time value (the value at 
the current time t) of the model manipulation floor reaction force 
moment calculated according to the above Equation d2 6 by the 
distributor 110 is supplied to the gait generator 100. 
[ 0595] 

The determined permissible range of the floor reaction force 
moment vertical component compensation amount is supplied to the 
aforesaid model manipulation floor reaction force moment 
vertic^al component determiner 111 (refer to Fig. 52). The 
current time value (the value at the current time t) of the model 
manipLilati on floor reaction force moment vertical component 
calcuJ.ated according to the aforesaid Equation d2 6b by the model 
manipulation floor reaction force moment vertical component 
determiner 111 is supplied to the gait generator 100. 
[0596] 

Subsequently, the processing of the gait generator 100 
proceeds to S3414 wherein the body horizontal acceleration and 
the body posture inclination angular acceleration of the current 
time gait are determined so that the model manipulation floor 
reaction force moment horizontal component supplied from the 
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c:omperLsa 1 1 ng total floor reaction force moment distributor 110 
is generated about the desired ZMP. However, the body horizontal 
acceleration and the body posture angular acceleration (the body 
inclination angular acceleration) are determined such that the 
floor redaction force horizontal component Fx does not exceed the 
floor reaction force horizontal component permissible range 
[Fxmir, Fxmax] determined in S3410. 
[05 97] 

In other words, the body horizontal acceleration and the body 
posture angular acceleration of the current time gait are 
determined so that the moment horizontal component generated 
aibout the desired ZMP by the resultant force of the inertial force 
and the gravity will be the moment with a reversed sign of the 
model manipulation floor reaction force moment horizontal 
component. However, the body horizontal acceleration and the 
body posture inclination angular acceleration are determined 
such that the force with the reversed sign of the horizontal 
component of the inertial force does not exceed the floor reaction 
force horizontal component permissible range [Fxmin, Fxmax] . 

[0598] 

Ir. S3414, specif leal J.y, the body horizontal acceleration and 
the body posture angular acceleration are determined according 
to the flowchart shown in Fig. 58. In this flowchart, the 
processing substantially the same as that shown in the aforesaid 
E'ig . 22 is performed. However, unlilce S504 and S530, S3104 and 
S3130 determine a body hoirizontal acceleration atmp required for 
the aforesaid model manipulation floor reaction force moment 
horizontal component to be generated about the desired ZMP of 
the current time (time k) in a case where the robot 1 is made 
to perform a motion of the body trans lational mode, setting the 
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angular acceleration of the body inclination mode to zero from 
the last time's instant gait state (the gait state at time k-1) 
of the robot 1 . 
[0599] 

5 Thus^ after the processing of S3414 is completed, the 

processing proceeds to S3416, wherein the same processing as that 
of S1414 of Fig. 42 is carried out to determine the horizontal 

body position and the body posture inclination angle 
(specifically, the current time values thereof at the current 
10 time t) . 

[0600] 

Subsequently, the processing proceeds to S3418 wherein the 
same processing as that of S1416 of Fig. 42 is carried out to 
determine an antiphase arm swing angle and angular velocity of 
15 the current time gait (specifically, the current time values 
thereof at the current time t) . 

Thus, the processing of S3032 of Fig. 55 is completed. 

[0601] 

Then, the processing proceeds to S3034 of Fig. 55 to correct 
20 the current time gait instantaneous value generated in S3032 so 
as to additionally generate a model manipulation floor reaction 
force moment vertical component about the desired ZMP , 
[0602] 

Specifically, a correction amount |3aadd of an antiphase arm 
25 swing angular acceleration corresponding to the model 
manipulation floor reaction force moment vertical component is 
determined according to the following equation. 

[0603] 

Correction amount paadd of antiphase arm swing angular 
30 acceleration = Model manipulation floor reaction force moment 
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vertical component / Equivalent inertial moment AMaz of 

antiphase arm swing motion 
[0604] 

Further, (3aadd is intiegrated during the period of a control 
5 cycle to determine a correction amount of the antiphase arm swing 
angular velocity, and then this is integrated to determine a 
correction amount of the antiphase arm swing angle. 

[0605] 

Lastly, the correction amount of the antiphase arm swing 
10 angle and the correction amount of the antiphase arm swing angular 
velocity are added to the antiphase arm swing angle and the 
angular velocity, respeictively , of the current time gait 
generated in S3032, thereby correcting the antiphase arm swing 
angle and the angular velocity of the current time gait. 
15 [0606] 

Subsequently, the processing proceeds to S3036 to add the 
control cycle At to time t, and goes back to S3014 to wait for 
a timer interrupt for each control cycle. 

[0607] 

20 As described above, the processing for generating a desired 

gait is carried out in the gait generator 100, and instantaneous 
values of ai desired body position/posture, a desired foot 
position/posture, a desired arm posture (including an antiphase 
arm swing angle), a desired ZMP, and a desired total floor 

25 reaction force are determined and output sequentially. 
[0608] 

In this case, regarding the desired total floor reaction 
force, only a component thereof that is necessary for compliance 
control may be output. The desired ZMP is deliberately listed 
30 here as an output although it is included in the desired total 
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floor reaction force, because it is particularly important. The 
model manipulation floor reaction force moment horizontal 
component is not output as a desired floor reaction force to the 
composite-compliance operation determiner (the portion 
encircled by a dashed line in Fig. 4) . More specifically, for 
the compliance control, ^he desired floor reaction force aimed 
at a zero floor reaction force moment horizontal component about 
the desired ZMP is output from the gait generator 100. 
[0609] 

The floor reaction force moment vertical component of the 
current time gait that has been corrected in S3034 is output as 
a desired value from the gait generator 100 to the 
composite-compliance control unit. 

[ C 6 1 0 ] 

As a first action of the present embodiment, a motion of a 
desired gait is generated such that a model manipulation floor 
reaction force moment horizontal component is produced about a 
desired ZMP, while the floor reaction force of the actual robot 
1 is controlled so as to prevent the model manipulation floor 
reaction force moment horizontal component from being added. 
Hence, there is an imbalance (unbalance) between the motion of 
the desired gait and the floor reaction force by the differential 
portion of the model manipulation floor reaction force moment 
horizontal component. This is equivalent to applying a floor 
reaction force moment horizontal component, which has a sign 
reversed from the sign of the model manipulation floor reaction 
force moment horizontal component, to the actual robot 1 from 
the aspect of the effect for converging a difference between the 
body posture inclination angle of the actual robot 1 and the body 
posture inclination angle of a desired gait. 
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[0611] 

111 other words, the actual robot 1 can be converged to a 
correc:ted desired gait by determining a model manipulation floor 
reaction force moment hori zontal component as appropriate . This 
means that the posture inclination of the actual robot 1 can be 
s tabi J. i zed . 

[0612] 

As a second action, the sum of a moment with a reversed sign 
of a model manipulation floor reaction force moment horizontal 
component and a desired floor reaction force moment horizontal 
component for compliance control provides a total inclination 
restoring force. This means that the difference between a 
desired floor reaction force moment horizontal component for 
compliance control and a model manipulation floor reaction force 
moment horizontal component provides a total posture inclination 
restoring force. 

[ C 6 1 3 ] 

As a third action, a model manipulation floor reaction force 
moment horizontal component can take any value, ignoring the 
range i.n which a ZMP can exist, thus making it possible to generate 
an extremely high posture inclination restoring force. 

[0614] 

As a fourth action, a body translational acceleration of the 
body t translational mode and a body posture inclination angular 
acceleration of the body inclination m,ode are determined such 
that a floor reaction force horizontal component does not exceed 
a floor reaction force horizontal component permissible range. 
This makes it possible to prevent slippage of the robot 1 even 
in a period wherein a large floor reaction force horizontal 
component cannot be generated, such as immediately before a 
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supporting leg 2 leaves a floor or immediately after it lands 
on a floor in a running gait, or when the robot 1 travels on a 
floor with a small frictional coefficient. 
[0615] 

5 As a fifth action, the permissible range of a floor reaction 

force norizontal component is set to zero in the period wherein 
the tr anslational force vertical component of a floor reaction 
force Ls zero, that is, in the period wherein neither of the legs 
is in contact with the ground, so that a posture inclination is 

j() automatically restored by depending upon the body inclination 
mode rather than depending upon the body transla t ional mode 
according to the algorithm of the first embodiment discussed 
above, thus performing the posture restoration without depending 
upon a frictional force between a floor and a sole. Accordingly, 

15 even in this period (flo£iting period), the posture inclination 
restoring action effectively works, unlike the method wherein 
only the body translcitional mode is merely corrected. 
Incidentally, at this time, the gait is generated so that the 
floor reaction force horizontal component becomes zero; 

20 therefore, the total center-of -gravity horizontal acceleration 
of the gait will be zero. 
[0616] 

Further, as a sixth action, a model manipulation floor 
reaction force moment horizontal component is not output as a 

25 desired floor reaction force for compliance control, as 
described above. More specifically, even when a gait is 
generated to produce a model manipulation floor reaction force 
moment horizontal component about a desired ZMP, a desired floor 
reaction force intended for setting a floor reaction force moment 

30 horizontal component about the desired ZMP to zero for compliance 
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contrci is supplied from the gait generator 100. Thus, the floor 
reaction force control by the compliance control will not be 
interfered with, allowing the floor reaction force control to 
be properly conducted by compliance control . To be more specific, 
5 it is possible to prevent or restrain the occurrence of a problem, 
such as one in that an originally designed property of a foot 
22 to (.contact the ground is deteriorated, or the sole of a foot 
22 incompletely contacts the ground. 
[ C 6 1 7 ] 

10 As it will be discussed hereinafter, a desired floor reaction 

force moment horizontal component for compliance control about 
a desired ZMP will be determined so as not to exceed a floor 
reaction force moment horizontal component permissible range 

also in a second embodiment and after. 
15 [ C 6 1 8 ] 

Incidentally, the first to the sixth actions are the same 
arts disclosed in PCT/ JP03/00435 previously proposed by the 
present applicant. 

[C619] 

20 As a s€3venth action, a motion of a desired gait is generated 

such t,hat a model manipulation floor reaction force moment 
vertical component is additionally produced about a desired ZMP, 
and the actual floor reaction force of the actual robot 1 is 
controlled by composite-compliance control to approximate to a 

25 desired value, the desired value being obtained by adding the 
compensating total floor reaction force moment vertical 
component Mdmdz to a desired floor reaction force moment vertical 
component that balances with the desired gait to which a model 
manipulation floor reaction force moment vertical component has 

30 been added by the gait generator 100. Hence, there is an 
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imbalance (unbalance) between the motion of the desired gait and 
the fl'jor reaction force by the differential portion of the model 
manipulation floor reaction force moment vertical component. 
This is equivalent to applying a floor reaction force moment 
5 horizontal component, which has a sign reversed from the sign 
of the model manipulation floor reaction force moment vertical 
component, to the actual robot 1 from the aspect of the effect 
for converging a difference between the body posture yaw angle 
of the actual robot 1 and the body posture yaw angle of a desired 
10 gait. 

[0620] 

In other words, appropriately determining the model 
manipulation floor reaction force moment vertical component 

makes it possible to converge the actual robot 1 to the corrected 
15 oesired gait. This means that the yaw rotation of the actual 
robot 1 can be stabilized. 
[0621] 

As an eighth action, the compensating total floor reaction 
force moment vertical component Mdmdz provides a total yaw 
20 rotation restoring force. The compensating total floor reaction 
force moment vertical component Mdmdz is determined so as to 
approximate a yaw angle error and/or a yaw angular velocity error 
to zero, thus making it possible to approximate the yaw angle 
error and/or a yaw angular velocity error to zero while ensuring 
25 control stability of yaw angle errors. 
[0622] 

As a tenth action, a model manipulation floor reaction force 

rrioment vertical component may take any value, ignoring the 
permissible range (or the frictional limit) of the floor reaction 
30 force moment vertical component, so that an extremely high 
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posture yaw rotation restoring force can be generated. 

1 C 62 3] 

As a tenth action, a final desired floor reaction force 
moment vertical component is determined for compliance control 
such that it does not exceed the sum of the permissible range 
of a floor reaction force moment vertical component and the 
permissible range of a floor reaction force moment vertical 
component compensating amount. This makes it possible to 
properly conduct the floor reaction force control based on the 
compliance control and therefore makes it possible to prevent 
the robot 1 from spinning even in a period wherein a large floor 
reaction force moment vertical component cannot be generated, 
such as immediately before a supporting leg 2 leaves a floor or 
immediately after it lands on a floor in a running gait, or when 
the roi:)ot 1 travels on a floor with a small frictional coefficient 
To be more specific, it is possible to prevent or restrain the 
occurrence of a problem, such as one in that an originally 
designed property of a foot 22 to contact the ground is 
deteriorated, or the sole of a foot 22 incompletely comes in 
contact with the ground. 

[ 0624 ] 

As an eleventh action, the permissible range of a floor 
reaction force vertical component and the permissible range of 
a floor reaction force moment vertical component compensation 
amount are set to zero in the period wherein the translational 
force vertical component of a floor reaction force is zero, that 
is, in the period wherein neither of the legs is in contact with 
the ground, so that yaw rotation is automatically restored by 
depending upon the antiphase arm swing mode rather than depending 
on an actual floor reaction force moment vertical component 
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accoraing to the algorithm of the present embodiment discussed 
above, thus performing the restoration of yaw rotation without 
depenaing upon a fricticnal force between a floor and a sole. 
Accordingly, even in this period (floating period), the yaw 
5 rotation restoring action effectively works, unlike the method 
wherein only the desired floor reaction force moment vertical 
component for compliance:' control is merely corrected. 
[G625] 

As a twelfth action, if a gait generated such that the moment 
!0 component produced about a desired ZMP (horizontal and vertical 
components) is zero is referred to as an original gait, and a 
gait generated such that the moment component produced about a 
desired ZMP provides a model manipulation floor reaction force 
moment component as in the aforesaid first embodiment, is 
15 referred to as a corrected gait, then the original gait and the 
corrected gait are usually different gaits. The original gait 
is set so that it gradually approximates to a normal gait, and 
therefore, the corrected gait is usually a gait that does not 
gradually approximate to a normal gait. 
20 [0626] 

However, immediately following the completion of the 
generation of a current time gait (corrected gait), the 
processing from S020 to S028 is carried out again to determine 
new current time gait parameters such that a new current time 
25 gait having a terminal state of the corrected gait as its new 
initial state gradually approximates a normal gait newly set. 
This makes it possible to continue generating gaits with 
continuously (long-range) guaranteed stability. 
[0627] 

30 A thirteenth action is substantially the same art as that 
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previcusly proposed in PCT / JPO 3 / 0 0 4 3 5 by the present applicant. 
In adoition thereto, however, in the present embodiment, the 
parameters related to an antiphase arm swing angle trajectory 
of a new current time gait are determined such that the antiphase 
5 arm swing angle trajectory of the new current time gait, which 
uses the terminal state of the antiphase arm swing angle and 
angular velocity corrected to restore the yaw angle rotation as 
the new initial state^ gradually approximates to the antiphase 
arm swing angle trajectory of the normal gait that is newly set. 
10 This makes it possible to continue generating gaits with 
continuously (long-range) guaranteed stability of the antiphase 
arm swing angle. 
[062 8] 

In the present embodiment, if the compensating total floor 
!5 reaction force moment horizontal component Mdmdxy takes a value 
within a floor reaction force moment horizontal component 
permissible range, then the model manipulation floor reaction 
force moment horizontal component will be zero. Alternatively, 
however, the model manipulation floor reaction force moment 
20 horizontal component at this time may be set according to the 
state amounts of the dynamic model shown in Fig. 10 (e.g., the 
center-of -gravi ty position of the robot on the dynamic model, 
and the position of the body mass point 3m) . 
[0629] 

25 Further, in the present embodiment, if the compensating 

total floor reaction force moment vertical component Mdmdz takes 
a value within a floor reaction force moment vertical component 
compensating amount permissible range, then the model 
manipulation floor reaction force moment vertical component 
30 compensating amount will be zero. Alternatively, however, the 
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model manipulation floor reaction force moment vertical 
component compensating amount at this time may be set according 
to the state amounts of the dynamic model shown in Fig. 10 (e.g., 
the antiphase arm swing angle and angular velocity, the body yaw 
5 angle, and angular velocity of the robot 1 on the dynamic model) . 
[0630] 

Referring now to Fig. 60 through Fig. 63, a third embodiment 
of the present invention will be explained. In the explanation 
of the present embodiment, the like constituent parts or like 
!0 functional parts as those the aforesaid first embodiment will 
be assigned like reference numerals as those in the aforesaid 
first embodiment, and the explanation thereof will be omitted. 
[0631] 

An outline of the aspects of the present embodiment will be 
i5 explained. An original gait and a corrected gait are generated 
at the same time. The corrected gait is obtained by correcting 
an original gait to stabilize a body posture (an inclination angle 
and a yaw angle) of the actual robot 1. Further, in the corrected 
gait. If the corrected gait still has an allowance (an allowance 
20 in a floor reaction force moment that can be generated about a 
desired ZMP) after generating a floor reaction force moment 
required for restoring a posture by compliance control, then it 
is determined to converge to the original gait as much as possible, 
using the allowance. 
25 [0632] 

A block diagram showing a functional construction of a 
control unit 26 in the present embodiment is shown in Fig. 60. 

In the present embodiment, a compensating total floor reaction 
force moment horizontal component Mdmdxy determined by a posture 
30 inclination stabilization control calculator 112 is supplied to 
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a gait generator 100. 
[0633] 

A compensating total floor reaction force moment vertical 
component Mdmdz determined by a yaw stabilization control 
5 calculator 113 is also supplied to the gait generator 100. 

[C634] 

Further, a compensating total floor reaction force moment 
distributor 120 that determines a model manipulation floor 
reaction force moment {ax horizontal component and a vertical 

10 component) and a desired floor reaction force moment (a 
horizontal component and a vertical component) for compliance 
control on the basis of the Mdmdxy and Mdmdz is incorporated in 
the gait generator 100. The desired floor reaction force moment 
tor compliance control is output from the gait generator 100 to 

15 a composite-compliance operation determiner 104. The 
compensating total floor reaction force moment distributor 120 
in the gait generator 100 performs more complicated processing 
than the compensating total floor reaction force moment 
horizontal component distributor 110 and the model manipulation 

20 floor reaction force moment vertical component determiner model 
111 of the aforesaid first embodiment. The functional 
oonsti'uction of the control unit 2 6 except for the above is 
identical to that in the first embodiment. 
[0635] 

25 Fig. 61 shows the flowchart of the main processing of the 

gait qenerator 100 in the present embodiment. 

[0636] 

In this Fig. 61, the same processing as that from S3010 to 
S3028 of the main flowchart (Fig. 55) of the second embodiment 
30 :ls carried out from S2010 to S2028. In the initialization in 
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£800 of the flowchart of Fig. 32 that is the subroutine of S028 
{S2028 in the present embodiment) , the initial state of a current 
time gait is obtained by converting the terminal state of the 
last t:-me' s corrected gair (the final gait that the gait generator 
5 100 outputs) into a current time's supporting leg coordinate 
system. The terminal state of the original gait determined in 
S2032, which will be discussed hereinafter, is not used in S800 
of the subroutine of S2028. 
[0637] 

10 Subsequently, the processing proceeds to S2030 wherein the 

floor reaction force moment horizontal component permissible 
range for compliance control is determined. The method for 

determining the floor reaction force moment horizontal component 
permissible range is the same as that in the second embodiment. 
15 [C638] 

After completing the processing of S2030, or if the 
deterrr.ination result of S2016 is NO, the program proceeds to S2032 
wherein an instantaneous value of the original gait (the current 
time value at time t) is determined. The original gait is a gait 

20 that :_s generated so that the floor reaction force moment 
horizontal component about a desired ZMP is zero. 
[0639] 

This original gait is generated according to an algorithm 
obtained by partly changing the subroutine processing of S3032 

25 of Fig. 55 in the aforesaid second embodiment . More specifically, 
in S3104 and S3130 of Fig. 58, which is the subroutine processing 
in S3032 (precisely, the subroutine processing of S3414 of Fig. 
57, which is the subroutine processing of S3032), a body 
horizontal acceleration atmp is determined, the model 

30 manipulation floor reaction force moment horizontal component 
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being zero (the desired floor reaction force moment horizontal 
component about a desired ZMP being zero) . The processing except 
for this may be the same as the processing of S3032 of Fig. 55. 
[0640] 

5 Subsequently^ the processing proceeds to S2034 wherein the 

instantaneous value of a corrected gait is determined. The 
corrected gait is the desired gait finally output from the gait 
generator 100. 
[0641] 

10 The processing of S2034 is implemented by the subroutine 

processing illustrated by the flowchart of Fig. 62. This will 
be explained in detail below. 

[0642] 

First, from S2100 to S2111, the same processing as that of 
15 S3400 to S3411 of Fig. 57 explained in the first embodiment is 
carried out.. 
[0643] 

Subsequently, the processing proceeds to S2112 wherein the 
floor reaction force moment horizontal component permissible 

20 range [Mxymin, Mxymaxj at the current time is determined on the 
basis of gait parameters. This is carried out in the same manner 
as that for determining the floor reaction force moment 
horizontal component permissible range [Mxymin, Mxymax] in 53412 
of Fig. 57. 

25 [0644] 

Subsequently, the processing proceeds to S2114 wherein a 
model manipulation floor reaction force moment (a horizontal 
component and a vertical component) , a desired floor reaction 
force moment for compliance control, a body horizontal 
30 acceleration, a body posture inclination angular acceleration, 
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and an antiphase arm swing angular acceleration are determined 
such that the conditions of a floor reaction force moment 
horizontal component permissible range, a floor reaction force 
moment vertical component permissible range, and a floor 
reaction force horizontal component permissible range are 
satisf ied . 
[0645] 

The details of S2114 will be explained below in conjunction 
with the flowchart of Fig. 63 that illustrates the processing. 
[0646] 

Fxrst, in S2200, the difference in horizontal body position 
between models, which is the difference between the horizontal 
body position of the corrected gait and the horizontal body 
position of the original gait, is determined. At this point, 
the current time value (the value at time t) of the horizontal 
body position of the corrected gait has not yet been determined. 
In S2200, therefore, the last time value (the last value 
determined in the control cycle at time t-At) of the horizontal 
body position of the corrected gait, and the last time value (the 
value determined in £;2032 in the control cycle at time t-At) or 
a current time value (the value determined in S2032 in the control 
cycle at t ime t) of the horizontal body position of the original 
gait are used to calculate the difference in horizontal body 
position between models. 

Subsequently, the processing proceeds to S2202 wherein the 
difference in body posture inclination angle between models, 
which is the difference between the body posture inclination 
angle of the corrected gait and the body posture inclination angle 
of the original gait, is determined. In this S2202, the last 
time value of the body posture inclination angle of the corrected 
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gait and Che last time value or the current time value of the 
body posture inclination angle of the original gait are used to 
aetermine the difference in body posture inclination angle 
between models, as in the case of the processing for calculating 
the difference in horizontal body position between models in 
£-,22 00 . 

[0647] 

Subsequently, the processing proceeds to S2204 wherein the 
difference in antiphase arm swing angle between models, which 
is the difference between the antiphase arm swing angle of the 
corrected gait and the antiphase arm swing angle of the original 
gait, is determined. In this S2204, the last time value of the 
antiphase arm swing angle of the corrected gait and the last time 
value or the current time value of the antiphase arm swing angle 
of the original gait are used to determine the difference in 
antiphase arm swing angle between models, as in the case of the 
processing for calculating the difference in horizontal body 
position between models in S2200. 
[ 0648 ] 

Subsequently, the processing proceeds to S2206 wherein, 
based on the difference in horizontal body position between 
models, a required value Mpfdmd of model horizontal body position 
stabilization floor reaction force moment that is necessary for 
converging the difference to zero is determined. If the floor 
reaction force moment for generating a body horizontal 
acceleration of the body trans lational mode of the corrected gait 
is merely balanced with the floor reaction force moment for 
generating a body horizontal acceleration of the body 
translational mode of the original gait, then the difference in 
horizontal body position between models diverges. The required 
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vaiu€^ Mpfdmd of model horizontal body position stabilization 
f looi reaction force moment has a meaning as a moment resulting 
from subtracting the floor reaction force moment for generating 
the body horizontal acceleration of the body translational mode 
5 of the original gait from the floor reaction force moment 
generated when a motion is made to return the horizontal body 
posit, ion of the corrected gait to the horizontal body position 
of the original gait by the aforesaid body translational mode. 
; 0 6 4 9 ] 

10 Specifically, the required value Mpfdmd of model horizontal 

body position stabilization floor reaction force moment is 
determined according to, for example, the feedback control law 
of the equation given below. In this example, the PD control 
law is used as the feedback control law; alternatively, however, 

15 othei: feedback control laws, such as PID, may be applied. 
:0650] 

Mpfdmd = Kmp * Difference in horizontal body position between 
models + Kmpv * Temporal differential value of the difference 
in horizontal body position between models 

20 Equation d28 

:0651] 

where Kmp and Kmpv denote feedback gains (a proportional gain 
and a differential gain) 
[0652] 

25 Subsequently, the processing proceeds to S2208 wherein, 

baseci on the difference in body posture inclination angle between 
models, a required value Mrfdmd of the floor reaction force moment 
for stabilizing a model body posture inclination angle that is 
necessary for converging the difference to zero is determined. 

30 If the floor reaction force moment for generating a body posture 
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inciination angular acceleration of the body inclination mode 
of the corrected gait is merely balanced with the floor reaction 
force moment for generating a body posture inclination angular 
acceleration of the body inclination mode of the original gait, 
5 then the difference in body posture inclination angle between 
models does not converge to zero. The required value Mrfdmd of 
the floor reaction force moment for stabilizing a model body 
posture inclination angle has a meaning as a moment resulting 
from subtracting the floor reaction force moment for generating 

10 the body posture inclination angle acceleration of the body 
inclination mode of the original gait from the floor reaction 
force moment generated when a motion is made to return the body 
posture .inclination angle of the corrected gait to the body 
posture inclination angle of the original gait by the aforesaid 

15 body inclination mode. 
: 0 6 5 3 ] 

Specifically, the required value Mrfdmd of the floor 
react, ion force moment for stabilizing a model body posture 
inclination angle is determined according to, for example, the 
20 feedback control law of the equation given below. In this 
example, the PD control law is used as the feedback control law; 
alternatively, however, other feedback control laws, such as PID, 
may be applied. 
[0654] 

25 Mrfdnd = Kmr ^ Difference in body posture inclination angle 

between models + Kmrv * Temporal differential value of the 
difference in body posture inclination angle between models 

Equation d29 

[0655] 

30 where Kmr and Kmrv denote feedback gains (a proportional gain 
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and 5 differential gam) 
[0656] 

S;ubsequently, the processing proceeds to S2210 wherein, 
basec on the difference in antiphase arm swing angle between 
models, a required value Maf dmd of the floor reaction force moment 
for :3tabilizing a model antiphase arm swing angle that is 
necessary for converging the difference to zero is determined. 
If the floor reaction force moment for generating an antiphase 
arm swing angular acceleration of the antiphase arm swing mode 
of the corrected gait is merely balanced with the floor reaction 
force moment for generating an antiphase arm swing angular 
acceleration of the antiphase arm swing mode of the original gait, 
then the antiphase arm swing angle between models does not 
conve^rge to zero. The required value Maf dmd of the floor 
react:ion force moment for stabilizing a model antiphase arm swing 
angle has a meaning as a moment resulting from subtracting the 
floor reaction force moment for generating the antiphase arm 
swincf angular acceleration of the antiphase arm swing mode of 
the original gait from the floor reaction force moment generated 
when a motion is made to return the antiphase arm swing angle 
of the corrected gait to the antiphase arm swing angle of the 
orig::.nal gait by an antiphase arm swing mode. 
[0657] 

Specifically, the required value Mafdmd of the floor 
reaction force moment for stabilizing a model antiphase arm swing 
angle is determined according to, for example, the feedback 
control law of the equation given below. In this example, the 
PD control law is used as the feedback control law; alternatively, 
however, other feedback control laws, such as PI D, may be applied . 

[065B] 
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Mafdrr.d = Ka ^ Difference in antiphase arm swing angle between 
rnociels + Kav ^ Temporal differential value of the difference in 
antiphase arm swing angle between models 

Equation d2 9b 

[0659] 

where Kar and Kav denote feedback gains (a proportional gain 
and a differential gain) . 

[0660] 

Incidentally, the moment obtained by subtracting the floor 
reaction force moment horizontal component for generating a body 
horizontal acceleration of the body translational mode of an 
original gait from the floor reaction force moment horizontal 
component generated by the body translational mode of a finally 
deter,n:iined corrected ga.it is called a floor reaction force moment 
for stiabilizing a model horizontal body position. Further, the 
moment obtained by subtracting the floor reaction force moment 
horizontal component for generating a body posture inclination 
angular acceleration of the body inclination motion mode of an 
original gait from the floor reaction force moment horizontal 
component generated by the body inclination motion mode of a 
finally determined corrected gait is called a floor reaction 
force moment for stabilizing a model body posture inclination 
angle. Further, the moment obtained by subtracting the floor 
react:.on force moment vertical component for generating an 
antiphase arm swing angular acceleration of the antiphase arm 
swing mode of an original gait from the floor reaction force 
moment vertical component generated by the antiphase arm swing 
mode of a finally determined corrected gait is called a floor 
reacti on force moment for stabilizing a model antiphase arm swing 
angle . 
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[06611 

Meanwhile, linearity approximately holds between a 
perturbation motion and a perturbation floor reaction force. In 
other words, the floor reaction force of a motion obtained by 
adding a different perturbation motion to the motion of an 
original gait substantially agrees with the floor reaction force 
of the original gait to which the perturbation floor reaction 
force: generated by each perturbation motion has been added. In 
the antiphase arm swing mode, a floor reaction force moment 
horizontal component remains unchanged. Hence, the following 
equat.ion approximately holds. 
.0662] 

Model manipulation floor reaction force moment horizontal 
component = Model horizontal body position stabilizing floor 
reactiion force moment f Model body posture inclination angle 
stabilizi.ng floor reaction force moment 

Equation d30 

;0 663] 

^"aking into account that the Equation d30 approximately 
holds and a floor reaction force moment vertical component 
changes in proportion to an antiphase arm swing angular 
acceleration, if a model horizontal body position stabilizing 
floor reaction force moment is determined so that it agrees with 
or approximates as much as possible to the required value Mpfdmd 
of model horizontal body position stabilizing floor reaction 
force moment, and a model body posture inclination angle 
stab.ilizing floor reaction force moment is determined so that 
it agrees with or approximates as much as possible to the required 
value Mrfdmd of a model body posture inclination angle 
stabilizing floor reaction force moment, and a model antiphase 
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arm swing angle stabilizing floor reaction force moment is 
determined so that J_t agrees with or approximates as much as 
possible to the required value Mafdmd of a model antiphase arm 
swine angle stabilizing floor reaction force moment, then a model 
manipulation floor reaction force moment appropriate for a 
corrected gait can be generated to converge the body horizontal 
acceleration and the body posture inclination angular 
acceleration of a corrected gait to possible ranges for the body 
hori2:ontal acceleration and the body posture inclination angular 
acceleration, respectively, of an original gait, while 
satisfying the restoring conditions shown below. 
::0664] 

Thus, after S2210, the processing proceeds to S2212 wherein 
a mociel horizontal body position stabilizing floor reaction 
forc€B moment (the floor reaction force moment of the body 
translational mode), a model body posture inclination angle 
stab:.lizing floor reaction force moment {the floor reaction 
force moment of the body inclination mode) , and a model antiphase 
arm swing angle stabilizing floor reaction force moment are 
determined to satisfy the conditions shown below (these are 
called 'Restoring conditions'' ) as much as possible . Furthermore, 
the body horizontal acceleration, the body posture inclination 
angular acceleration, and the antiphase arm swing angular 
acceleration of a corrected gait are determined to satisfy the 
definitions of the model horizontal body position stabilizing 
floor reaction force moment, the model body posture inclination 
angle stabilizing floor reaction force moment, and the model 
antiphase arm swing angle stabilizing floor reaction force 
moment described above. Regarding the restoring conditions 
shown below, conditions with smaller numbers have higher 
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priorities. In other words, if conflicting, incompatible 
conditions are encountered, then priority goes to a condition 
with a smaller number will be satisfied (met) . However, 
restoring conditions of 1, 2 and 3 must always be satisfied (met) . 
I 0665] 

Restoring condition 1) The sum of the compensating total 
flooi reaction force moment horizontal component Mdmdxy and a 
mode], manipulation floor reaction force moment (this corresponds 
to a desired floor reaction force moment horizontal component 
for compliance control if the above Equation d27b holds) does 
not exceed a floor reaction force moment horizontal component 
permi,ssible range . 
;0666] 

Restoring condition 2) The floor reaction force horizontal 
component of a corrected gait does not exceed a floor reaction 
force horizontal component permissible range. 

[0667] 

Restoring condition 3) The sum of the floor reaction force 
moment vertical component of a corrected gait and a compensating 
total floor reaction force moment vertical component Mdmdz (this 
corresponds to a desired floor reaction force moment vertical 
component for compliance control) does not exceed a floor 
reaction force moment vertical component permissible range. 

[0668] 

Restoring condition 4) A model body posture inclination 
angle stabilization floor reaction force moment agrees with or 
is close as much as possible to a required model body posture 
inclination angle stabilization floor reaction force moment 
value Mrfdmd. This condition is the condition for the body 
posture inclination angle of a corrected gait to converge to the 
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body posture inclination angle of an original gait (originally 
planned gait ) . 
[06691 

Restoring condition 5) A model horizontal body position 
stabi lization floor reaction force moment agrees with or is close 
as much as possible to a required value Mpfdmd of model horizontal 
body position stabilization floor reaction force moment. This 
condition is the condition for a horizontal body position of a 
corrected gait to converge to the horizontal body position of 
an oi iginal gait (originally planned gait) . 
^0670] 

Restoring condition 6) A model antiphase arm swing angle 
stab] lization floor reaction force moment agrees with or is close 
as much as possible to a required value Mafdmd of model antiphase 
arm swing angle stabilization floor reaction force moment. This 
condition is the condition for the antiphase arm swing angle of 
a corrected gait to converge to the antiphase arm swing angle 
of an original gait (originally planned gait) . 
[0671] 

Restoring condition 7) A model body posture inclination 
angle stabilization floor reaction force moment, a model 
hori :^.ontal body position stabilization floor reaction force 
moment, and a model antiphase arm swing angle stabilization floor 
reaction force moment are all continuous. 

[0672] 

The processing of S2212 for determining a body horizontal 
acceleration, a body posture inclination angle acceleration, an 
antiphase arm swing angular acceleration, etc. that satisfy the 
restoring conditions 1 through 6 described above is carried out, 
for example, as follows. 

-261 - 



[06731 

F'irst, in order to satisfy the aforesaid restoring 
conditions 1, 2, 4, and 5, a model horizontal body position 
stabilization floor reaction force moment and a model body 
posture inclination angle stabilization floor reaction force 
moment are determined, and further a body horizontal 
acceleration and a body posture inclination angular acceleration 
are determined. This processing is discussed in detail in the 
art -^f PCT/ JP03/00435 previously proposed by the present 
applicant, so that the explanation thereof will be omitted here. 

[0674] 

Subsequently, the model antiphase arm swing stabilization 
floor reaction force moment is determined to satisfy the 

aforesaid restoring conditions 3 and 6, and further, the 
antiphase arm swing angular acceleration is determined. 
[0675] 

Specifically, a floor reaction force moment vertical 
component about a desired ZMP that is generated (dynamically 
balarcinq the motion) if a motion is provisionally implemented 
at tne body horizontal acceleration and the body posture 
inclination angular acceleration determined as described above 
and at an antiphase arm swing angular acceleration Paorg of an 
original gait is determined. Hereinafter, this will be referred 
to as ci floor reaction force moment vertical component without 
correction . 

S^ubsequently , a sum Msumz of a floor reaction force moment 

vertical component without correction, the required value Mafdmd 
of model antiphase arm swing angle stabilization floor reaction 
force moment, and a compensating total floor reaction force 
moment vertical component Mdmdz is determined according to the 
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follow.ing equation. 
[0676] 

Msumz: = Floor reaction force moment vertical component 
wi thout correction 

+ Mafdmd + Mdmdz 
[0677] 

Subsequently, a model antiphase arm swing stabilization 
floor reaction force moment is determined according to the 
fol lowing equation . 

[0678] 

If Msumz > Upper limit value of a floor reaction force moment 
vertical component permissible range, then 

l^^odel antiphase arm swing stabilization floor reaction force 
moment ^ -Mdmdz 

- Floor reaction force moment vertical component without 
correction 

4 Upp>er limit value of the floor reaction force moment 
vertical component permissible range. 

[0679] 

If Msumz < Lower limit value of a floor reaction force moment 
vertical component permissible range, then 

Model antiphase arm swing stabilization floor reaction force 
moment = -Mdmdz 

- Floor reaction force moment vertical component without 
correction 

^ Lower limit value of the floor reaction force moment 

vertical component permissible range. 
[0680] 

If a lower limit value of a floor reaction force moment 
vertical component permissible range < Msumz and Msumz < Upper 
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] imit value of the floor reaction force moment vertical component 
permissible range, then 

Model antiphase arm swing stabilization floor reaction force 
moment 

3 = Required value Mafdmd of model antiphase arm swing angle 

stabilization floor reaction force moment 

Equation d2 6c 

[0681] 

Subsequently, the antiphase arm swing angular acceleration 
10 of a corrected gait is determined according to the following 
equation . 

[0682] 

Antiphase arm swing angular acceleration of corrected gait 

= Original gait antiphase arm swing angular acceleration |3aorg 
15 + Model antiphase arm swing stabilization floor reaction force 

moment 

/ Equivalent inertia 1 moment of arm swing motion AMaz 
[0683] 

The floor reaction force moment vertical component of the 
20 corrected gait is the sum of the antiphase arm swing angular 
acceleration of the original gait (3aorg and the model antiphase 
arm sv/ing stabilization floor reaction force moment . Therefore, 
the aforesaid restoring condition 3 is satisfied by determining 
the model antiphase arm swing stabilization floor reaction force 
25 moment according to the above equations . 
[0684] 

After carrying out the processing of S2212 as described above, 
the program processing proceeds to S2214 wherein a model 
manipulation floor reaction force moment horizontal component 
30 is de^termined according to the above equation d30. More 
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specx f ica lly, the sum of the model horizontal body position 
stabilization floor reaction force moment and the model body 
posture inclination angle stabilization floor reaction force 
moment that has been obtained in S2208 is determined as the model 
manipulation floor reaction force moment horizontal component. 
Alternatively, the floor reaction force moment about a desired 
ZMP may be directly calculated on the basis of a current time 
instantaneous value of the motion of a finally determined 
corrected gait, and the calculation result may be defined as the 
model manipulation floor reaction force moment. 
[0685] 

Subsequently, the processing proceeds to S2216 wherein a 
desired floor reaction force moment horizontal component for 
compliance control is determined according to the above equation 
d27b . More specifically, the sum of the compensating total floor 
reaction force moment horizontal component Mdmdxy and the model 
manipulation floor reaction force moment horizontal component 
obtained in S2214 is determined as the desired floor reaction 
force mom.ent horizontal component for compliance control. 
I 0 686] 

Subsequently, the processing proceeds to S2218 wherein a 
desii-ed floor reaction force moment vertical component for 
comp] iance control is determined according to the equation shown 
in the figure. The floor reaction force moment vertical 
component that balances with the corrected gait in the equation 
shown in the figure (dynamically balances with the motion of the 
corrected gait) is the sum of a floor reaction force moment 
vertical without correction and a model antiphase arm swing 
stabilization floor reaction force moment. Alternatively, 
however, the floor reaction force moment vertical component 
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about a desired ZMP may be directly calculated on the basis of 
a current time instantaneous value of the motion of a finally 
determined corrected gait. 
[0687] 

5 Thus, the processing of S2114 of Fig. 62 is finished, and 

then the processing proceeds to S2116. The processing of this 
S2116 IS the same as that of S3416 of Fig. 57 in the aforesaid 
first embodiment; the current time value of a horizontal body 
position is determined by the second order integration of a body 

10 horizontal acceleration and the current value of a body posture 
inclination angle is determined by the second order integration 
of a body posture inclination angle acceleration. 
[0688] 

Subsequently, the processing proceeds to S2118. The 
15 processing in this S2118 is the same as that of S3418 of Fig. 
57 in the aforesaid first embodiment; the current time value of 
an antiphase arm swing angle is determined by the second order 
integration of an antiphase arm swing angular acceleration. 
! 0689] 

20 Subsequently, the processing proceeds to S2036 of Fig. 61 

to acid a control cycle At to time t, and then returns to S2014 
wherein it waits for a timer interrupt for each control cycle. 
:0690] 

Supplementally, to determine a gait instantaneous value on 
25 the basis of a dynamic model in the present embodiment, the state 
amount of the dynamic model (or the last time's or the last but 

one time' s gait instantaneous values) are also necessary, so that 
two dynamic models, for generating a corrected gait and for 
generating an original gait are necessary. 
30 [0691] 
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In the present embodiment, as discussed above, an original 
gait and a corrected gait are generated in parallel, and the 
corrected gait is corrected to stabilize the posture (the 
inclination angle and the yaw angle) of the actual robot 1. If 

5 there is still an allowance even after a floor reaction force 
moment (a horizontal component and a vertical component) 
required for posture restoration by compliance control is 
generated, then the allowance is used for convergence to an 
original gait as much as possible. Therefore, in addition to 

10 the action advantages of the aforesaid second embodiment, a gait 
close to an initially set original gait, that is, a gait 
approximated to the gait initially required, can be generated. 
Hence, if a preset travel path is provided, then it will be 
possible to prevent significant deviation from the travel path. 

15 Moreover, a priority has been given to the convergence of the 
body posture inclination angle of the corrected gait to the body 
posture inclination angle of an original gait (the initially 
determined gait) rather than to the convergence of the horizontal 
body position of the corrected gait to the horizontal body 

20 position of the original gait (the initially determined 
gait) (the motion of the body translat ional mode has been adjusted 
as much as possible within the range in which a floor reaction 
force horizontal component permissible range is satisfied) , thus 
making it possible to restrain a significant change in the body 

25 posture inclination angle. 
:0 692] 

Referring now to Fig, 64 through Fig. 73, a fourth embodiment 
of the present invention will be explained. In the explanation 
of the present embodiment, the like constituent parts or like 
30 functional parts as those in the aforesaid first to third 

-267 - 



embodiments will be assigned like reference numerals as those 
m the aforesaid first: to third embodiments, and detailed 
explanation thereof will be omitted. 
[0693] 

5 In the present embodiment, the functional construction of 

a control unit 26 is the same as that of the third embodiment, 
that is, the same as that shown in Fig. 60 mentioned above. 
However, in the present embodiment, the algorithm for generating 
gaits executed by a gait generator 100 is different from that 

10 of the aforesaid third embodiment. And the processing of units 
other than the gait generator 100 is identical to that of the 
aforesaid third embodiment. 
I 0694 ] 

rig. 64 is a block diagram showing an outline of the 
15 processing of the gait generator 100 in the present embodiment. 
Refeiring to this Fig. 64, an outline of the processing of the 
gait generator 100 will be explained below. Incidentally, the 
outline of the processing to be explained below in conjunction 
with Fig. 64 will apply also to a fifth to a seventh embodiments 
20 to be? discussed hereinafter. 
:0 695] 

As illustrated, the gait generator 100 is equipped with a 
gait parameter determiner 100a. The gait parameter determiner 
100a determines a value of a parameter of a desired gait (the 
25 parameter defining the desired gait) or a time series table 
thereof. This corresponds to the processing of S3520 through 
33530 of the flowchart of Fig. 65 to be discussed hereinafter. 
[0696] 

Although details will be given hereinafter, parameters 
30 determined by the gait parameter determiner 100a includes the 
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parameters that define a desired foot position/posture 
trajectory, a desired arm posture trajectory, a reference body 
posture trajectory, a desired ZMP trajectory, a desired floor 
reaction force vertical component trajectory, etc. in addition 
to a parameter that defines a floor reaction force horizontal 
component permissible range, a parameter that defines a ZMP 
permissible range, and a parameter that defines a floor reaction 
force moment vertical component permissible range. In this case, 
the floor reaction force horizontal component permissible range 
and the floor reaction force moment vertical component 
permissible range to be set in the present embodiment come in 
two types, one for simplified model gaits set by the processing 
of S3526 to be described later and the other for correcting gait 
to be set in S3530. Meanwhile, a ZMP permissible range comes 
in only one type for correcting a gait set by the processing of 
S 3 5 3 C' . 

0 6 97 ] 

Here, the ZMP permissible range corresponding to the 
permi.ssible range of the floor reaction moment horizontal 
component m the present embodiment will be set as shown in Fig. 
56. The details have been given in PCT / JPO 3 / 0 0 4 3 5 , so that 
further explanation will be omitted. 
[069B] 

A gait parameter determined by the gait parameter determiner 
100a is input to a desired instantaneous value generator 100b. 
Based on the input gait parameter, the desired instantaneous 
value generator 100b sequentially calculates (generates) the 
instantaneous values of desired foot position/posture, a desired 
ZMP, a desired floor reaction force vertical component, a desired 
arm posture, a desired total center-of -gravity vertical position, 
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a de.sired vertical body position, a floor reaction force 
horizontal component permissible range, a ZMP permissible range, 
a reference body posture angle, and a reference antiphase arm 
swing angle at current time t (Fig. 64 describes only a part of 
desired instantaneous values) . The processing of the desired 
instantaneous value generator 100b corresponds to the processing 
of S3400 through S3412 of Fig. 57 carried out in the processing 
of S3 532 of the flowchart of Fig. 65 to be discussed hereinafter 
and the processing of S3534 of Fig. 65 . In the present embodiment, 
of the desired instantaneous values calculated by the desired 
instantaneous value generator 100b, some instantaneous values 
(specifically,, the instantaneous value of a desired vertical 
body position) are provisional values, which will be corrected 
later. The instantaneous values of the floor reaction force 
hori2.ontal component permissible range and the floor reaction 
force moment vertical component permissible range calculated by 
the desired instantaneous value generator 100b come in the 
instantaneous values for simplified model gaits and the 
instantaneous values for correcting gaits. 
; 0 6 9 9 ] 

Desired instantaneous values (some are provisional 
instantaneous values) calculated (generated) by the desired 
instantaneous value generator 100b are input to a full-model 
correction unit 100c. Also input to the full-model correction 
unit 100c are the compensating total floor reaction force moment 
horizontal component Mdmdxy determined by the aforesaid posture 
inclination stabilization control calculator 112 (refer to Fig. 
60) and the compensating total floor reaction force moment 
vertical component Mdmdz determined by the aforesaid yaw 
stabilization control calculator 113 (refer to Fig. 60) . The 
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full-model correction unit 100c is provided with a simplified 
TRodel lOOcl and a full model 100c2 as dynamic models. Based on 
the srmplified model lOOcl, the full-model correction unit 100c 
determines the provisional instantaneous values or the like of 
5 a des:-red body position/posture and an antiphase arm swing angle 
from the input values, and further corrects the provisional 
instantaneous values or the like of the determined body 
position/posture and the antiphase arm swing angle by using the 
full model 100c2. 
10 [07 00] 

As an alternative construction, the simplified model lOOcl 
may not be included in the full-model correction unit 100c2, The 
full model 100c2 includes either an inverse full model (an inverse 

dynamic full model) or a forward full model (a forward dynamic 
15 full model), as will be discussed hereinafter. 
[0701] 

The full-model correction unit 100c basically executes the 
processing of B to satisfy the following conditions Al through 
A4 . Specifically, the full-model correction unit 100c carries 

20 out B) given below to satisfy the following conditions: 

Al) tne value obtained by adding the compensating total floor 
reaction force moment horizontal component Mdmdxy and the 
compensating total floor reaction force moment vertical 
component Mdmdz to the floor reaction force moment balancing the 

25 motion of a corrected gait generated by the full-model correction 
unit 100c agrees with the floor reaction force moment for 
compl Lance control that is output from the full-model correction 
unit lOOc, 

A2 ) a true ZMP (the ZMP that satisfies the original definition 
30 corrected by generating a desired floor reaction force moment 
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for compliance control about a desired ZMP) lies in a ZMP 
permissible range (a permissible range that allows a sufficient 
stability allowance to be maintained) , 

A3) a floor reaction force horizontal component lies in the floor 
reaction force horizontal component permissible range for 
correcting a gait, and 

A4 ) a desired floor reaction force moment vertical component for 
compliance control to be generated about a desired ZMP lies in 
a floor reaction force moment vertical component permissible 
range . 

B) The full-model correction unit 100c corrects the body 
position/posture of a simplified model gait determined using the 
simplified model, and outputs the desired floor reaction force 

moment for compliance control about the desired ZMP. 
[0702] 

The above condition A2 is equivalent to restricting a floor 
reaction force moment generated about the desired ZMP to a floor 
reaction force moment horizontal component permissible range 
that corresponds to a ZMP permissible range. 

[0703] 

Here, the aforesaid simpl i f led model lOOcl and the aforesaid 
full model 100c2 will be explained. The simplified model lOOcl 
is a dynamic model with an emphasis placed on a reduced volume 
of calculation or the ease of behavior analysis rather than 
dynamic accuracy, and may ignore some dynamic elements (e.g., 
ignore a change in the angular momentum about the center of 
gravity) or may have contradiction (lack in preciseness ) . In 
the present embodiment, the dynamic model of Fig. 10 explained 
in the aforesaid first embodiment (the dynamic model described 
in conjunction with the above Equations 01 to 05) is used as the 
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simplified model lOOcl. 
[0704] 

The full model 100c:2 means a robot dynamic model that is 
different from the simplified model lOOcl. This is desirably 
a robot dynamic model having approximation accuracy higher than 
that of the simplified model lOOcl. This will be explained in 
conjunction with the illustrated example. As previously 
descxibed, in the present embodiment, the dynamic model shown 
in tl-ie above Fig. 10 is used as the simplified model lOOcl; 
therefore, a dynamic model having a higher approximation 
accuiacy than that, such as the robot dynamic model like the 
multi-mass point model (the model having a mass point for each 
link of the robot 1) shown in, for example. Fig. 11 mentioned 
above, is desirably used as a full model 100c2. In this case, 
the full model 100c2 may be such that an inertial moment is set 
about: a mass point. 
;07 05] 

However, the simplified model lOOcl and the full model 100c2 
do not have to necessarily have different model approximation 
accuracy. The simplified model lOOcl and the full model 100c2 
may ^jhare the same dynamic equations and have different floor 
reaction force horizontal component permissible ranges and/or 
floor reaction force moment vertical component permissible 
ranges, that is, they may be different only in the permissible 
range for simplified model gaits and the permissible range for 
gait correction. For instance, the floor reaction force 
horizontal component permissible range and the floor reaction 
force moment vertical component permissible range for generating 
gaits by the simplified model lOOcl may be merely set to be wide 
(may even exceed a frictional limit) , while setting narrow ranges 
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for the floor reaction force horizontal component permissible 
range and the floor reaction force moment vertical component 
permissible range applied for correcting gaits using the full 
model 100c2, thereby making it difficult for the robot 1 to slip 
5 or spin. 

[07 06] 

In the present description, the model used to calculate 
(output) body position/posture and an antiphase arm swing angle 
on the basis of (by entering) desired foot position/posture, a 

10 desired floor reaction force (particularly, a desired ZMP and 
a desired floor reaction force vertical component) is called the 
''forward dynamic model." The model used to calculate (output) 
a floor reaction force (especially a desired ZMP or a floor 
reaction force moment (a horizontal component and a vertical 

15 component) and a floor reaction force horizontal component) on 
the basis of (by entering) desired foot position/posture, a 
desired body posture, a desired body position and an antiphase 
arm swing angle is called the "inverse dynamic model.'' An input 
of the forward dynamic model includes at least a desired floor 

20 reaction force, while an input of the inverse dynamic model 
includes at least a desired motion. 
[ 0707 ] 

The full model 100c2 provided in the full-model correction 
unit 100c is equipped with an inverse dynamic full model 
25 (frequently referred to simply as ''inverse full model") or a 
forward dynamic full model (frequently referred to simply as 

"forward full model''). In general, the volume of calculation 
of a forward dynamic model tends to be greater than that of an 
inverse dynamic model. 
30 10708] 
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The above is the outline of the processing in the gait 

g e n e r" a t: o r 10 0. 
[0709] 

The processing of the gait generator 100 in the present 
embodiment: will now be explained in detail. The gait generator 
100 in the present embodiment carries out the processing shown 
in the flowchart of Fig. 65 to generate gaits. 

[3710] 

First, the same processing as the processing from S3010 to 
33028 of Fig. 55 explained in the aforesaid second embodiment 
is carried out in S3510 to S3528. The floor reaction force 
horizcDntal component permissible range for a current time gait 
determined in S608 of Fig. 23, which is the subroutine of S3026, 
and t.he floor reaction force moment vertical component 
permissible range determined in S610 require less strict 
consideration given to the limit of a frictional force than in 
T:he case of the first embodiment, the second embodiment and the 
third embodiment, and may be set to ranges that exceed the limit 
of th€.^ frictional force. This is because the floor reaction 
force horizontal component and the floor reaction force moment 
vertic:al component will be eventually restricted by a floor 
reaction force horizontal component permissible range and a 
floor reaction force moment vertical component permissible range 
for full miodel correction by the full model correction, which 
v;ill be discussed hereinafter. 

[ Ci 7 1 1 ] 

Subsequently, the processing proceeds to S3530 wherein the 
parameters defining the floor reaction force horizontal 
component permissible range, the floor reaction force moment 
vertical component permissible range, and the ZMP permissible 
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range (floor reaction force central point permissible range) for 
full model correction (for gait correction) are determined. In 
this case, the floor reaction force horizontal component 
permiosible range for full model correction is set to have a 
pattern, as shown in the aforesaid Fig. 30, on the basis of a 
floor reaction force vertical component trajectory and the above 
Equation 12 for the X-axis direction (the longitudinal 
direc^iion; and the Y-axis direction (the lateral direction), 
respectively, as in the case of, for example, the floor reaction 
force horizontal component permissible range for the aforesaid 
simpl:_fied model gaits. Then, for example, the value of ka*ia 
of th€^ above Equation 12 is set as the parameter that defines 
the floor reaction force horizontal component permissible range 
for full model correction. However, the floor reaction force 
horizontal component permissible range is desirably set to that 
it securely falls within the range of a frictional limit by, for 
exampJe, setting the value of coefficient ka of Equation 12 to 
be smaller than the floor reaction force horizontal component 
permissible range for simplified model gaits. 
[ Ci 7 1 2 ] 

Thie floor reaction force moment vertical component 
permissible range is set in the same manner as that for the floor 
reaction force horizont6il component permissible range. 

[C713] 

The ZMP permissible range is set in the same manner as that 
for the case explained in conjunction with the setting of the 
floor reaction force moment horizontal component permissible 
range :.n S3030 of Fig. 5 5 in the aforementioned second embodiment . 
The ZM}^ permissible range may be of course converted into a floor 
reaction force moment horizontal component permissible range 
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equivalent thereto by multiplying the ZMP permissible range by 
a desired floor reaction force vertical component. 
[0714] 

Subsequently, the processing proceeds to S3532 wherein the 
5 instantaneous value of the current time gait (the value at the 
current time t) is determined using the aforesaid simplified 
model (the dynamic model shown in Fig. 10) . The processing of 
this S3532 is identical to the processing of S030 of Fig. 12 in 
the aforesaid first embodiment . 
10 [3715] 

Tne instantaneous value of the gait at the current time t 
generated by the processing up to S3532 explained above will be 
hereinafter referred to as the simplified model gait 
ins taj it aneous value. In the present embodiment^ the simplified 
15 model gait instantaneous value is determined using a simplified 
model (the dynamic model shown in Fig. 10) such that the floor 
reaction force moment horizontal component generated about a 
desired ZMP by the resultant force of the inertial force and 
gravity generated in the robot 1 by a motion thereof is zero (such 
20 that a dynamic balance condition related to the desired ZMP is 
satisfied) . 

[0716 ! 

In this case, of the simplified model gait instantaneous 
values, the instantaneous values of a horizontal body position 
25 and a body posture inclination angle, the instantaneous value 
of a vertical body position, and an instantaneous value of an 

antiphase arm swing angle are provisional instantaneous values 
and will be corrected by full model correction to be discussed 
later. Further, of the simplified model gait instantaneous 
30 values in the present embodiment, the instantaneous value of the 
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desired floor reaction force moment horizontal component about 
the desired ZMP is normally zero, whereas a desired floor reaction 
force moment horizontal component for compliance control as the 
desired value of the floor reaction force moment horizontal 
component generated about the desired ZMP by the full model 
correction, which will be discussed later, is generated. 
[ 3717 ] 

Subsequently, the processing proceeds to S3534 wherein the 
instantaneous values (the values at the current time t) of the 
floor reaction force horizontal component permissible range, the 
floor reaction force moment vertical component permissible range, 
and the ZMP permissible range for gait correction are determined 
on the basis of the parameters (which have been set in S3530) 
rhat define the floor reaction force horizontal component 
permissible range, the floor reaction force moment vertical 
component permissible range, and the ZMP permissible range for 
gait correction. 

[0718] 

Subsequently, the processing proceeds to S3536 wherein the 
full model is used to generate a corrected gait (to correct the 
gait) so as to determine the instantaneous value of a final 
desired gait. More specifically, as explained with reference 
to the aforesaid Fig. 64, the calculation (determination) of 
corrected desired body position/posture, a corrected desired 
antiphase arm swing angle, and a desired floor reaction force 
moment (a horizontal component and a vertical component) for 
compliance control as a desired floor reaction force moment (a 
horizontal component and a vertical component) about a desired 
ZMP is mainly performed. 

[0719] 
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Subsequently, the processing proceeds to S3538 to increment 
the tirae t by At, and returns to S3514 again to repeat the 
processing from S3514 to S3538. 

[0720 I 

The processing of S3536 described above, which constitutes 
a chajracteristic of the present embodiment, will be explained 
in det,ail below. The gait correcting technique of a device in 
accordance with the present embodiment is a full-model 
feedforward correction type. Furthermore, the gait correction 
technique uses an inverse dynamic full model (inverse full mode) , 
and i-~ is a technique that does not correct an input of a 
simplified model gait, and it is a technique that uses a 
pertui bati on model . 

[0721] 

Fig. 66 is a functional block diagram explaining the 
operation of the gait generator 100 according to the present 
embodiment, specifically, the technique for correcting a gait 
in S3536 of the flowchart of Fig. 65. A simplified model 200 
shown in Fig. 66 represents not only a dynamic model but the 
processing of S3510 to S3532 discussed above, namely, the 
processing of calculating (determining) the instantaneous value 
of a s:,mpli.fied model gait. In Fig. 66, therefore, the portion 
beyond the simplified model 200 corresponds to the processing 
of S3536. 

[0722 J 

The processing for determining the instantaneous values of 

the floor reaction force horizontal component permissible range 
and the ZMP permissible range for gait correction (for full model 
correction) is shown using a reference mark S3 53 4 of the flowchart 
of Fig. 65. 
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[3723] 

Tne actual processing is implemented by a single computer, 
so that it is implemented in order toward a downstream side 
(toward a gait output side) from an upstream side of the block 
5 diagram after the block diagram is broken up. However, a 
feedback amount returned to the upstream side uses a value (a 
state amount) calculated in the last control cycle (time t-At 
with respect to the current time t). Hereinafter, the value 
calculated in the last time control cycle (time t-At) will be 
10 abbreviated as a last time value. 
[0724.1 

Each time the processing of S3536 is carried out, the 
calculation for one control cycle in the block diagram is 
per formed . 
15 [ (] 7 2 5 J 

In S3536, first, the instantaneous values of variables 
representing a motion (this is called a motion variable), such 
as th€e desired body posture angle (hereinafter referred to as 
the simplified model body posture angle. Further, an 

20 inclination angle component thereof will be referred to as the 
simplified model body posture inclination angle), the desired 
horizontal body position (hereinafter referred to as the 
simplified model horizontal body position) , the desired 
center-of -gravity position, the desired foot position/posture, 

25 and the desired arm posture (including the desired antiphase arm 
swing angle) of the simplified model gait obtained as described 
above, and the instantaneous value of a desired ZMP are input 
to the aforesaid inverse dynamic full model (inverse full model) 
201 . The floor reaction force horizontal component and the floor 

.>0 reaction force moment about the desired ZMP (a horizontal 
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component and a vertical component) , balancing the motion 
repreoented by the input motion variables (in other words, a full 
model is generated by the motion) , are calculated by the 
calculation processing of the inverse full model 201. In the 
present embodiment, the floor reaction force moment horizontal 
component about the desired ZMP in the simplified model gait is 
zero, so that the floor reaction force moment horizontal 
component about the desired ZMP calculated by the inverse full 
model 201 has a meaning as an error of a simplified model gait. 
[0726] 

Incidentally, the floor reaction force horizontal component, 
the floor reaction force moment horizontal component, and the 
floor reaction force moment vertical component determined by the 
inverse full model 201 are called ''the full-model floor reaction 
force horizontal component," ''the full-model floor reaction 
force moment horizontal component," and ''the full-model floor 
reaction force moment vertical component," respectively. 
Hereinafter, the full-model floor reaction force horizontal 
component will be frequently abbreviated as Ffull, the 
full-model floor reaction force moment horizontal component will 
be frequently abbreviated as Mfullxy, and the full-model floor 
reaction force moment vertical component will be frequently 
abbreviated as Mfullz. 

[ C 7 2 7 ] 

Furthermore, the aforesaid inverse full model 201 calculates 
the vertical body position that satisfies a desired 

center-of-gravity position. Although not shown, the inverse 
full model 201 also calculates the center-of-gravity horizontal 
pos i t ion . 

[0728] 
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Supplementally, a desired total center-of -gravity vertical 
position is input to the full model, and a desired floor reaction 
force vertical component is determined from the second order 
differential value of the desired total center-of -gravity 
verti(::al position. Hence, there is no particular need to input 
a desiLred floor reaction force vertical component to the full 
model. For a reason of achieving a reduction of calculation or 
the like, a desired floor reaction force vertical component may 
be input to the full model even if it is redundant. 

[0729 J 

A perturbation model used for gait correction will now be 

expla:_ned . 
[0730] 

The perturbation model is composed of a horizontal body 
positj.cn correcting perturbation model 202, a body posture 
iincliriation angle correcting perturbation model 203, and an 
antipiiase arm swing angle correcting perturbation model 231. 
The perturbation model may be a single model shown in Fig. 10 
rathei- than being composed of such three separate models. 

[0731] 

Tiie horizontal body position correcting perturbation model 
202 represents the relationship between the perturbation of a 
floor reaction force and the perturbation of a horizontal body 
position in the aforesaid body translational mode. 

[C732] 

The horizontal body position correcting perturbation model 
202 rec:eives a correction amount of a desired floor reaction force 

moment and calculates a correction amount of a desired horizontal 
body position that dynamically balances with the received 
correction amount of the desired floor reaction force moment. 
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This -.riput (the correction amount of the desired floor reaction 
force moment) is called a perturbation model moment for 
correlating horizontal body position Mp . An output (the 
correction amount of a desired horizontal body position) of the 
norizontal body position correcting perturbation model 202 is 
calleci a correcting perturbation model horizontal body position 
Xc . The floor reaction force horizontal component generated by 
rhe hc>rizontal body position correcting perturbation model 202 
-Ls caJled a perturbation model floor reaction force horizontal 
component for correcting horizontal body position Fp . 
[07 33] 

The horizontal body position correcting perturbation model 
202 is represented by an inverted pendulum composed of a support 
point, an inverted pendulum mass point (body mass point) and an 
extensible support rod connecting them, as shown in Fig. 67. The 
position of the support point is set so that the horizontal 
p)Osition of the support point agrees with the horizontal position 
of the origin of the current time' s gait supporting leg coordinate 
system, described above, and the vertical position of the support 
point agrees with the vertical position of a desired ZMP . Amass 
mb of :he inverted pendulum mass point is identical to the mass 
of the body mass point of the aforesaid simplified model (the 
model with 3 mass points + flywheels) shown in Fig. 12. A 
vertical position Zc of the inverted pendulum mass point is to 
be identical to a vertical position Zb of the body mass point 
position of the simplified model shown in Fig. 10, which 
corresponds to a simplified gait. 

[0734] 

The horizontal body position correcting perturbation model 
202 shows the relationship between a perturbation AMy of a floor 
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reaction force moment and a perturbation AXb of a body mass point 
horiz<3ntaL position in the aforesaid simplified model. 

! D '7 3 5 I 

Hence, assuming that parameters other than My, Xb, and Zb 
take constants, if the relationship between the perturbation AMy 
of a floor reaction force moment and the perturbation AXb of a 
body mass point horizontal position is determined from the above 
Equation 03y, then the following equation will be obtained. 

[073 6] 

AMy - -mb^AXb^ {g+d2Zb/dt2) +mb^ (Zb-Zzmp) ^d2AXb/dt2 
... Equation al2 
[07 37] 

Similarly, assuming that parameters other than Fx and Xb take 
constants, if the relationship between the perturbation AFx of 
a floor reaction force horizontal component and the perturbation 
AXb of a body mass point horizontal position is determined from 
the above Equation 02x, then the following equation will be 
obtai ned . 

[0738] 

AFx = mb * d2AXb/dt2... Equation al3 

[0739] 

A l:)ody trans la tional mode floor reaction force ratio h, which 
is the ratio of AMp to AFp generated by a horizontal body 
acceleration, is the ratio of the term generated by the horizontal 
body acceleration (that is, the second term) of the right side 
of Equation al2 to Equation al3, so that the following equation 
will be obtained. 

[07 40] 

H = ( Zb - Zzmp)... Equation al4 

[0741 ] 
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Ii other words, the body t ranslat ional mode floor reaction 
force ratio h corresponds to the height from the support point 
of th€ body mass point (the inverted pendulum mass point) of the 
3 impl ... f ied model . 

L0742.: 

Accordingly, the following equation is derived from Equation 
al2 and Equation al4. 
[07 43] 

AMy=-mb^AXb^ (g + d2Zb/dt2) +mb*h^d2AXb/dt2... Equation al5 
[ 0744] 

M6?anwhile, the floor reaction force vertical component that 
balanc:es with the translat ional force vertical component of the 
result.ant force of the gravity and the inertial force acting on 
the body mass point ( the inverted pendulum mass point) is referred 
to as a body floor reaction force vertical component Fbz. 
Specifically, the body floor reaction force vertical component 
Fbz is defined by the following equation. 

[C745] 

Fbz = mb ^ (g + d2Zb/dt2 ) ... Equation al6 

[ C 7 4 6 J 

And, from the Equation a8, the body floor reaction force 
vertical component Fbz is determined from the following 
equat ion . 

[0747] 

Fbz-Fz-msup* { g+d2 Z sup/dt 2 ) -mswg* ( g+d2 Zswg/dt2 ) 

... Equation al7 

[0748] 

In other words, the body floor reaction force vertical 
component is equal to the sum of the floor reaction force vertical 
component Fz and the trans lational force vertical component of 
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the resultant force of the gravity and the inertial force acting 

on bot:h leg mass points of the aforesaid simplified model (the 
model with 3 mass points + flywheels) shown in Fig. 12. 
[0749] 

Substituting Equation al6 into Equation al5 provides the 
f ol lovN/ing equation . 
[0750] 

AMy = -Fbz^AXb+mb^h^d2AXb/dt2... Equation al8 

[07 51] 

Associating AMy of Equation al8 with the perturbation model 
moment: for correcting horizontal body position Mp, and 
associating AXb with the correcting perturbation model 
horizontal body position Xc ( substituting the perturbation model 
moment for correcting horizontal body position Mp into AMy of 
Equatd on a 1 8 , and subs tit uting the correcting perturbation model 
horizontal body position Xc into AXb) provide the following 
equat i on . 

[07 52] 

Mp = -Fbz*Xc+mb^h*d2Xc/dt2... Equation al9 
[ C 7 5 3 ] 

Ir ottier words, the horizontal body position correcting 
perturbation model 202 is expressed by Equation al9 by using the 
body t ranslational mode floor reaction force ratio h determined 
according to Equation al4 and the body floor reaction force 
vertical component Fbz determined according to Equation al7. 

[0754] 

Further, associating AFx of Equation al3 with the 

perturbation model floor reaction force horizontal component for 
correcting horizontal body position Fp provides the following 
equat ion . 
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[ D755 .1 

Fp = mb ^ d2Xc/dt2... Equation a20 

[ 0 7 5 6 1 

111 other words, the horizontal body position correcting 
perturbation model 202 2.s described by Equation al4. Equation 
al7. Equation al9, and Equation a20. 

[0757] 

Supplementally, it is regarded here that the perturbation 
of a body mass point position and the perturbation of a body 
position (the position of a body representative point) agree; 
strict.ly speaking, however, they do not always agree. 
Accordingly, to determine the relationship among Mp, Fp, and Xc, 
a model that expresses a geometric relationship between the 
horizontal position of a body mass point and a body position is 
further necessary. 

[ C 7 5 8 ] 

Meanwhile, a body posture inclination angle correcting 
perturbation model 203 represents a relationship between the 
perturbation of a floor reaction force and a body posture 
inclination angle in the aforesaid body inclination mode. 

[0759] 

The body posture inclination angle correcting perturbation 
model 203 receives a correction amount of a floor reaction force 
moment horizontal component and calculates a correction amount 
of a desired body posture inclination angle that dynamically 
balances with the received correction amount of the floor 
reaction force moment horizontal component. This input (the 
correction amount of the floor reaction force moment) is called 
a perturbation model moment for correcting body posture 
inclination angle Mr. An output (the correction amount of a 
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desired body posture inclination angle) of the body posture 
inclination angle correcting perturbation model 203 is called 
a coriecting perturbation model body posture inclination angle 
0c. The floor reaction force horizontal component generated by 
rhe body posture inclination angle correcting perturbation model 
203 is called a perturbation model floor reaction force 
horizontal component for correcting horizontal body position Fr . 
Fr is zero as mentioned above. This means that the following 
equation always holds. 
[ 0760] 

F2^ 0,.. Equation a21 
[0761] 

The body posture inclination angle correcting perturbation 
model 203 is expressed by a flywheel FH as shown in Fig. 68. 
(Supplementally, a flywheel that rotates about the X-axis in 
addition to the flywheel rotating about the Y-axis is required.) 
The inertia of those flywheels are the same as the flywheels FHx 
and FHy of the aforesaid simplified model (the model with 3 mass 
points + flywheels) shown in Fig. 10. The rotational angle of 
a flywheel of the body posture inclination angle correcting 
perturbation model 203 corresponds to the correcting 
perturbation model body posture inclination angle 0c, and the 
floor reaction force moment horizontal component generated by 
the flywheel corresponds to the perturbation model moment Mr for 
correcting body posture inclination angle. 

[0762] 

The body posture inclination angle correcting perturbation 
model 203 expresses a relationship between the floor reaction 
force moment perturbation AMy and the body posture inclination 
angle perturbation ABby in the aforesaid Equation 03y of the 
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dynamic equation of the aforesaid simplified model (the model 
with 3 mass points + flywheels) . 
[07 63] 

Accordingly, if parameters other than My and 6by are regarded 
as constants, and if the relationship between the floor reaction 
force moment horizontal component perturbation AMy and the body 
posture inclination angle perturbation A9by is determined 
according to Equation 03y, then the following equation will be 
obtained . 

[0764] 

AMy - J * d2Aeby/dt2... Equation a22 
[0765] 

Associating AMy of Equation a22 with the perturbation model 
moment for correcting body posture inclination angle Mr, and 
associating AGby with the correcting perturbation model body 
posture inclination angle Gc provide the following equation. 

[0766] 

Mr - J ^ d2Aec/dt2... Equation a23 
[C767] 

Ir other words, the body posture inclination angle 
correcting perturbation model 203 is represented by equation a23. 
The perturbation model floor reaction force horizontal component 
for correcting horizontal body position Fr is determined 
according to Equation a21 as described above { Fr = 0) . 

[0768] 

An antiphase arm swing angle correcting perturbation model 
231 shows the relationship between the perturbation of a floor 

reaction force and the perturbation of an antiphase arm swing 
angle in the antiphase arm swing mode. 
[0769] 
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The antiphase arm swing angle correcting perturbation model 
231 receives a correction amount of a floor reaction force moment 
vert.ic:al component and calculates a correction amount of a 
desire^d antiphase arm swing angle that dynamically balances with 
the received correction amount of the floor reaction force moment 
vertical component. This input (the correction amount of the 
floor reaction force moment vertical component) is called a 
perturbation model moment for correcting antiphase arm swing 
^lngie Ma. An output (the correction amount of a desired 
antiphase arm swing angle) of the antiphase arm swing angle 
correcting perturbation model 203 is called a correcting 
perturbation model antiphase arm swing angle 9ca . The floor 
reaction force horizontal component generated by the 
perturbation model for correcting antiphase arm swing angle is 
callec a perturbation model floor reaction force horizontal 
component for correcting antiphase arm swing angle Fa. Fa is 
zero as described above. This means that the following equation 
always holds . 

[0770] 

Fa = 0 ... Equation a21c 

[0771] 

The antiphase arm swing angle correcting perturbation model 
231 is expressed by a flywheel, as shown in Fig. 69. The inertia 
of the flywheel is the same as the flywheel FHaz of the aforesaid 
simplified model (the model with 3 mass points -f flywheels) shown 
in Fig. 10. The rotational angle of the flywheel of the antiphase 
arm swing angle correcting perturbation model 231 corresponds 
to the correcting perturbation model antiphase arm swing angle 
Gca, and the floor reaction force moment vertical component 
generated by the flywheel corresponds to the perturbation model 
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moment: for correcting antiphase arm swing angle Ma. 

[07721 

The antiphase arm swing angle correcting perturbation model 
231 expresses a relationship between the floor reaction force 
moment perturbation AMz and the antiphase arm swing angle 
pertui-bat j on AGaz in the aforesaid Equation 03z of the dynamic 
equation of the aforesaid simplified model (the model with 3 mass 
points; + t lywheels) . 

[ 0773 ] 

Ac:cordingly , if parameters other than Mz and Gaz are regarded 
ais constants, and if the relationship between the floor reaction 
force moment perturbation AMz and the antiphase arm swing angle 
pertuibation AGaz is determined according to Equation 03z, then 
t:he fC'l lowing equation will be obtained. 
[ Ci774 1 

AMz - Jaz ^ d2Aeaz/dt2... Equation a22c 

[Ci7 75] 

Associating AMz of Equation a22c with the perturbation model 
moment for correcting antiphase arm swing angle Ma, and 
associating AGaz with the correcting perturbation model 
antiphase eirm swing angle Qca provide the following equation. 

[ C 7 7 6 ] 

Ma = Jaz * d2AGca/dt2... Equation a23c 
[ C 7 7 7 ] 

In other words, the antiphase arm swing angle correcting 
perturbation model 231 is represented by equation a23c. The 
perturbation model floor reaction force horizontal component for 

correcting antiphase arm swing angle Fr is determined according 
to Equation a21c as described above (Fa = 0) . 
[0778] 
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Ar. it will be discussed later^ in S3536, a corrected gait 
(to be more specific, a desired instantaneous value with some 
instantaneous values of a simplified model gait corrected) are 
eventually generated (output) . A desired body posture 
5 J_nclination angle of the corrected gait (hereinafter referred 
to as the corrected desired body posture inclination angle) is 
obtained by adding the aforesaid correcting perturbation model 
body posture inclination angle 0c (the value determined in the 
control cycle at the current time t) to the instantaneous value 
10 of the aforesaid determined simplified model body posture 
inclination angle (the instantaneous value of the desired body 
posture inclination angle at the current time t of the current 
time gait determined in S3032) by a calculator 204. The desired 
horizontal body position of the corrected gait (hereinafter 
15 referred to as the corrected desired horizontal body position) 
is obtained by adding the correcting perturbation model 
horizontal body position Xc (the value determined in the control 
cycle at the current time t) to the instantaneous value of the 
aforesaid determined simplified model horizontal body position 

20 (the instantaneous value of the desired horizontal body position 
at the current time t of the current time gait determined in S032) 
by a calculator 205. Further, a desired antiphase arm swing 
angle of a corrected gait (hereinafter referred to as the 
corrected desired antiphase arm swing angle) is obtained by 

25 adding the correcting perturbation model antiphase arm swing 
angle 6ca (the value determined in the control cycle at the 
current time t) to the instantaneous value of the aforesaid 
determined simplified model antiphase arm swing angle (the 
instantaneous value of the desired antiphase arm swing angle at 

30 the current time t of the current time gait determined in S032) 
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by a c:alculator. 
[0779] 

The desired floor reaction force of the corrected gait is 
cilso corrected. Specifically, the floor reaction force moment 
horizontal component about the desired ZMP is no longer zero, 
and the desired floor reaction force moment horizontal component 
for compliance control is output as a desired value. Further, 
the desired floor reaction force horizontal component is also 
corrected to a corrected desired floor reaction force horizontal 
component and output. In addition, the desired floor reaction 
force moment vertical component is corrected to a corrected 
desired floor reaction force moment vertical component and 
output . 

[ C 7 8 0 ] 

As described above, the motion of the corrected gait is the 
motion obtained by adding (combining) the motions of 
perturbation models (to be more specific, the motions of the 
horizontal body position correcting perturbation model and the 
body posture inclination angle correcting perturbation model and 
the motion of the antiphase arm swing angle correcting 
perturbation model) to the motion of a simplified model gait. 

[0781] 

In general, the floor reaction force generated by a motion 
obtained by adding a certain perturbation motion to a certain 
reference motion is approximated by the sum of the floor reaction 
force generated by the reference motion (the floor reaction force 
counterbalancing the gravity and the inertial force generated 
by the motion) and the perturbational portion of the floor 
reaction force generated by the perturbation motion. 

[0782] 
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Cc^ns icier ing that the floor reaction force horizontal 
component generated by the body inclination mode, the floor 
react:. on force moment vertical component generated by the body 
incl inat ion mode , the floor reaction force horizontal component 
5 generated by the antiphase arm swing mode, and the floor reaction 
force moment horizontal component generated by the antiphase arm 
swing mode are all zero, the three equations given below must 
be satisfied so as to satisfy the dynamic equilibrium condition 
V7ith high accuracy, in other words, to match the floor reaction 
10 force generated on the inverse full model 201 by the motion of 
a corrected gait with a corrected desired floor reaction force 
s ub stantially. 
[ C) 7 8 3 ] 

Full-model floor reaction force moment horizontal component 
15 Mfullxy 

-f- Perl:urbation model moment for correcting horizontal body 
position Mp 

i Perturbation model moment for correcting body posture 
inclination angle Mr 
20 + Compensating total floor reaction force moment horizontal 

component Mdmdxy 

- Corrected desired floor reaction force moment horizontal 
component 

Equation h5 
25 [07 84] 

Full-model floor reaction force horizontal component Ffull 

+ Perturbation model floor reaction force horizontal component 
for correcting horizontal body position Fp 

Corrected desired floor reaction force horizontal component 
30 ... Equ^ution h6 
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[ 0785 ; 

F'u 1 1 -mode 1 floor reaiction force moment vertical component 
Mf ull2; 

- Perturbation model moment vertical component for correcting 
horizontai body position Mpz 

^ Perturbation model moment vertical component for correcting 
antiphase arm swing angle Maz 

-i- Compensating total floor reaction force moment vertical 
component Mdmdz 

Corrected desired floor reaction force moment vertical 
component 

... Equation hl006 
[078 6 1 

whiere the perturbation model moment vertical component for 
correcting horizontal body position Mpz denotes the floor 
reaction force moment vertical component generated on the 
inverse full model 201 by a motion of the perturbation model for 
correcting horizontal body position. The moments of Equation 
h5 and Equation hl006 are the moments about an original 
(simplified model's) desired ZMP. 

[ C 7 8 7 ] 

The true ZMP of a corrected gait is changed to a point deviated 
from the desired ZMP (ideal desired ZMP) of a simplified model 
gait by the value obtained by dividing a corrected desired floor 
reaction force moment by a desired floor reaction force vertical 
component . 

[0788] 

True ZMP of corrected gait = Desired ZMP 

+ Corrected desired floor reaction force moment / Desired 
floor reaction force vertical component 
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Equation hi 

[ 07 89 i 

To calculate the component in the X direction (longitudinal 
direction) of the true ZMP of a corrected gait, the component 
5 about the Y-axis (lateral axis) of a corrected desired floor 
react:.on force moment is used. Further, to calculate the 
component in the Y direction of the true ZMP of a corrected gait, 
the component about the X-axis (longitudinal axis) of a corrected 
desire^d floor reaction force moment is used. However, when 
10 calculating the component in the Y direction of the true ZMP of 
a corrected gait, of the right side of Equation hi must be 

changed to 
[ 0790] 

Supplementally, a corrected desired floor reaction force 
15 moment, vertical component about the true ZMP of a corrected gait 
may be calculated, as an alternative. 
[0791] 

The corrected desired floor reaction force moment vertical 
component about the true ZMP of a corrected gait will be the 

20 outcome obtained by adding the outer product of the difference 
between the true ZMP of a corrected gait and a desired ZMP and 
the corrected desired floor reaction force horizontal component 
determined according to Equation h6 to the moment about an 
original desired ZMP. 

25 [0792] 

The true ZMP of the corrected gait determined according to 
Equation h7 must fall within a ZMP permissible range. This is 

called a ZMP restriction condition. 
[ C 7 9 3 ] 

30 The corrected desired floor reaction force horizontal 
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component must fall within a floor reaction force horizontal 
r:omponent permissible range for correcting gait. This is called 
a floor reaction force horizontal component restriction 
condi t i on . 
5 [0794] 

The corrected desired floor reaction force moment vertical 
component must fall within a floor reaction force moment vertical 
component permissible range for correcting gait (for full-model 
c:orrec:t ion ) . This is called a floor reaction force moment 
10 vertic:al component restriction condition. 
[ 0795] 

As described above, a corrected gait must satisfy Equation 
h5. Equation h6. Equation hlOOG, the ZMP restriction condition 
;the condition of a range in which the true ZMP of the corrected 
15 gait obtained from Equation h7 exists) , the floor reaction force 
horizc)ntal component restriction condition, and the floor 
reliction force moment vertical component restriction condition. 
[0796] 

However, merely satisfying these equations and conditions 
20 v7ould cause divergence of the aforesaid correcting perturbation 
model body position, the aforesaid correcting perturbation model 
body p'Osture inclination angle, and the aforesaid correcting 
perturbation model antiphase arm swing angle. 
[C797] 

25 Therefore, on the basis of the state amounts of the aforesaid 

horizontal body position correcting perturbation model 202, the 

aforesaid body posture inclination angle correcting 
perturbation model 203, and the aforesaid antiphase arm swing 
angle correcting perturbation model 231 (to be more specific, 
30 correcting perturbation model's horizontal body 
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posit . .on/veloci ty , correcting perturbation model ' s body posture 
.inclination angle/angular velocity, and correcting perturbation 
model's antiphase arm swing angle/angular velocity, etc.)/' the 
stabilization control of the correcting perturbation models 202, 
5 203, emd 231 is conducte^d so as to converge (stabilize) these 
state amounts to predetermined states . 
[0798] 

F:_rst, the stabilization control of the horizontal body 
positj on correcting perturbation model 202 will be explained in 
10 detai]. . 

[07 99] 

The control law for converging (stabilizing) the horizontal 
body p)Osition correcting perturbation, model 202 to a desired 
stead^y^ position is referred to as a perturbation model control 
15 law 206 for correcting hoirizontal body position, and the feedback 
amount (manipulation amount) determined by this control law is 
referied to as a required value Mpfdmd of perturbation model 
stabilization moment for correcting horizontal body position. 
The term ''required value" has been added because restriction is 
20 added to the value determined according to the above control law 
to correct it such that the true ZMP exits in the aforesaid ZMP 
permissible range and the floor reaction force horizontal 
component falls within a floor reaction force horizontal 
component permissible range, as it will be discussed hereinafter. 
25 The moment corrected by adding restriction thereto is referred 
to as the horizontal body position correcting perturbation model 
stabilization moment Mpf. 

[0800] 

Specifically, the perturbation model control law 206 for 
30 correcting horizontal body position uses Equation hlO . However, 
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a desired steady position is given by Equation h8 . Further, 
mtota 1 denotes the total weight of the aforesaid robot, mb denotes 
the mass of the aforesaid body mass point ( the mass of the inverted 
pendu:Lum) , and XGf denotes the center-of -gravity horizontal 
posit:.on calculated using a full model on the basis of an 
instantaneous posture of a simplified model gait, that is, the 
center-of-gravity horizontal position calculated by the 
aforesaid inverse full model. Further, Kpp and Kpv denote the 
gains of feedback control. 

Desired steady position = -mtotal /mb* (XGf -XGs ) 
... Equation h8 

Required value Mpfdmd of perturbation model stabilizing moment 
for ccrrecting horizontal body position 

Kpp* (Correcting perturbation model horizontal body position 
Xc -- Lesired steady position) 

+ Kpv ^ Correcting perturbation model horizontal body velocity 
dXc/dt 

- Correcting perturbation model horizontal body position Xc * 
Body floor reaction force vertical component Fbz 

... Equation hlO 

[0801] 

To determine the component about the X-axis (longitudinal 
axis) of the required value Mpfdmd of perturbation model 
stabilizing moment for correcting horizontal body position, a 

correcting perturbation model horizontal body position velocity 
and a desired steady position use a component in the Y-axis 
direction (lateral direction). 
[0 302] 



-299- 



T'.) determine the component about the Y-axis (lateral axis) 
of the. required value Mpfdmd of perturbation model stabilizing 
moment: for correcting horizontal body position, a correcting 
perturbation model horizontal body position velocity and a 
5 desired steady position use a component in the X-axis direction 
( long:. tudinal direction) ^ and in the third term of the right 

side :,s re^placed by + 
[ (] 8 0 3 J 

The details have been described in PCT/ JP03/00435 previously 
10 proposed by the present applicant, so that further explanation 
will be omitted. 
[0804] 

The stabilization control of the body posture inclination 
angle correcting perturbation model 203 will be explained in 
I 5 detail . 

[0805] 

According to the state of the body posture inclination angle 
correc:ting perturbation model 203, a feedback amount 
(manij:)ulat ion amount) is determined according to a feedback 

20 control law, such as the PI control, so that a corrected desired 
body posture inclination angle, that is, the inclination angle 
obtained by adding a correcting perturbation model body posture 
inclination angle to a desired body posture inclination angle 
based on a simplified model , stabilizes to or follows a reference 

25 body posture inclination angle (determined in S3404 of Fig. 57) 
output, by the desired instantaneous value generator 100b or a 
desircid body posture inclination angle (obtained in S3414 of Fig. 
57) baised on a simplified model, and the determined feedback 
amount is additionally input to the body posture inclination 

30 angle correcting perturbation model 203. 
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[08 0 6] 

This control law is referred to as a body posture inclination 
angle correcting perturbation model control law 207, and the 
feedback amount (manipulation amount) is referred to as a 
required value Mrfdmd of perturbation model stabilizing moment 
for correcting body posture inclination angle. The term 
^^requ:-red value" has been added for the same reason as that for 
the required value Mpfdmd of perturbation model stabilizing 
moment for correcting horizontal body position. The moment 
corrected by adding restriction thereto is referred to as 
perturbation model stabilizing moment Mrf for correcting body 
posture inclination angle. 
[ 3807 ] 

Specifically, the body posture inclination angle correcting 
perturbation model control law 207 for determining the required 
value Mrfdmd of perturbation model stabilizing moment for 
correcting body posture inclination angle is implemented 
according to the equation given below. 

Required value Mrfdmd of perturbation model stabilizing moment 
for correcting body posture inclination angle 

= Krp ^ (Correcting perturbation model body posture inclination 
angle 9c 

- (Reference body posture inclination angle - Desired body 
posture inclination angle based on simplified model)) 
+ Krv ^ Correcting perturbation model body posture inclination 

angular velocity dGc/dt 
... Equation hll 

where Krp and Krv denote feedback control gains, 
i; 0 8 0 8 ] 



In Equation hll, (Reference body posture inclination angle 
- Desired body posture inclination angle based on simplified 
model) may be replaced by zero. 

[C809] 

5 The processing in S3536 will be explained by referring back 

to the functional block diagram of Fig. 66. As described above, 
the required value Mpfdmd of perturbation model stabilization 
moment for correcting horizontal body position is determined 
accoraing to the perturbation model control law 206 for 

10 correc:ting horizontal body position (Equation hlO) . Further, 
the required value Mrfdmd of perturbation model stabilization 
moment. for correcting body posture inclination angle is 
determined according to the body posture inclination angle 
correctinq perturbation model control law 207 (Equation hll). 

15 [0810] 

Subsequently, an estimated (calculated) value FO of floor 
reaction force of the perturbation model for correcting body 
position when it is assumed that the horizontal body position 
correcting perturbation model stabilization moment Mpf is zero 

20 is determined by a FO calculator 208. As it will be discussed 
hereinafter, the full-model floor reaction force moment 
horizontal component Mfullxy to which the horizontal body 
position correcting perturbation model stabilization moment Mpf 
has been added is supplied to the horizontal body position 

25 correcting perturbation model 202. Hence, FO is the floor 
reaction force generated by the horizontal body position 
correcting perturbation model 202 if only the full-model floor 
reaction force moment horizontal component Mfullxy with a 
reversed sign is supplied to the horizontal body position 

30 correcting perturbation model 202. 
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[0811] 

Specifically, FO is determined according to the equation 
given bcslow. 
[0812] 

FO = mb * d2Xc/dt2 - 1/h * Mpf... Equation hl2 

[0813] 

The first term of the right side denotes a floor reaction 
force horizontal component of the horizontal body position 
correcting perturbation model 202 of the last time (time t - At) . 
[0814] 

The second term of the right side denotes the floor reaction 
force horizontal component directly generated in (i.e., a direct 
term of) the horizontal body position correcting perturbation 
model 202 by the horizontal body position correcting 
perturbation model stabilizing moment Mpf of the last time. 
[0815] 

More specifically, the estimated value of the floor reaction 
force FO of a body position correcting perturbation model when 
It is assumed that Mpf is zero is determined by subtracting the 
value, which is obtained by dividing the horizontal body position 
correcting perturbation model stabilization moment Mpf of the 
last time by the body t rans lat ional mode floor reaction force 
ratio h, from the value obtained by multiplying the body mass 
point horizontal acceleration of the last-time of the horizontal 
body position correcting perturbation model 202 by the mass mb 
of the body mass point. 
[0816] 

Subsequently, if it is assumed that the horizontal body 
position correcting perturbation model stabilization moment Mpf 
is matched with the required value Mpfdmd of horizontal body 
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position correcting perturbation model stabilization moment, 
the bo(iy posture inclination angle correcting perturbation model 
stabilization moment Mrf is matched with the required value 
Mrfdmd of body posture inclination angle correcting perturbation 
model stabilization moment, a desired floor reaction force 
moment for compliance control as a desired floor reaction force 
moment horizontal component about a desired ZMP is matched with 
the total sum of the compensating total floor reaction force 
moment horizontal component Mdmdxy, Mpf , and Mrf , while ignoring 
the aforesaid restriction (the floor reaction force horizontal 
component restrictive condition and the ZMP restrictive 
condition) , then the floor reaction force moment horizontal 
component Min generated about the desired ZMP is determined by 
a Min calculator 209. This floor reaction force moment 
horizontal component is referred to as a corrected desired floor 
reaction force moment horizontal component without restriction 
Min. The corrected desired floor reaction force moment 
horizontal component without restriction Min is determined 
according to the following equation. 
[ C 8 1 7 ] 

Min = Mpfdmd + Mrfdmd + Mdmdxy ... Equation hi 3 

[ C 8 1 8 ] 

This means that the corrected desired floor reaction force moment 
horizontal component ' wi thout restriction Min is obtained by 
adding the required value Mpfdmd of horizontal body position 
correcting perturbation model stabilization moment, the 
required value Mrfdmd of body posture inclination angle 
correcting perturbation model stabilization moment, and the 
compensating total floor reaction force moment horizontal 
component Mdmdxy. 
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[ C 8 1 9 1 

Subsequently, if it is assumed that the horizontal body 
position correcting perturbation model stabilization moment Mpf 
is matched with the required value Mpfdmd of horizontal body 
position correcting perturbation model stabilization moment, 
the body posture inclination angle correcting perturbation model 
stabilization moment Mrf is matched with the required value 
Mrfdmd of body posture inclination angle correcting perturbation 
model stabilization moment, and a desired floor reaction force 
moment for compliance control is matched with the total sum of 
the compensating total floor reaction force moment horizontal 
component Mdmdxy, Mpf, and Mrf, while ignoring the aforesaid 
restriction (the floor reaction force horizontal component 
restrictive condition and the ZMP restrictive condition), then 
the f I'Dor reaction force horizontal component Fin to be generated 
is determined by a Fin calculator 210. This floor reaction force 
horizontal component is referred to as a corrected desired floor 
reaction force horizontal component without restriction Fin. 

[ Ci 8 2 0 ] 

Tl^.e corrected desired floor reaction force horizontal 
component is obtained by the above Equation h6. As described 
above, no floor reaction force horizontal component is generated 
in the body posture inclination angle correcting perturbation 
model 203 by a behavior of the body posture inclination angle 
correcting perturbation model 203, meaning that Fr is zero. 
Accoroingly, the corrected desired floor reaction force 
horizcntal component without restriction Fin is obtained by 
adding the floor reaction force horizontal component, which is 
increased by changing the horizontal body position correcting 
perturbation model stabilization moment Mpf from zero to the 
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irequired value Mpfdmd of horizontal body position correcting 
pertuibation model stabilization moment, to the corrected 
desired floor reaction force horizontal component in a case where 
it is assumed that the horizontal body position correcting 
perturbation model stabilization moment Mpf is zero. 
[0821] 

Incidentally, the floor reaction force horizontal component, 
which IS increased by changing the horizontal body position 
correcting perturbation model stabilization moment Mpf from zero 
to the required value Mpfdmd of horizontal body position 
correc:ting perturbation model stabilization moment, takes a 
value obtained by dividing the required value Mpfdmd of 
horizontal body position correcting perturbation model 
stabiJ-izat ion moment by the body t ranslational mode floor 
reaction force ratio h. 

[0822] 

Hence, as shown by Equation hl5, the corrected desired floor 
reaction force horizontal component without restriction Fin is 
obtained by adding the aforesaid determined full-model floor 
react:_on force horizontal component Ffull to the value obtained 
by dividing the required value Mpfdmd of horizontal body position 
correc:tinc^ perturbation model stabilization moment by the body 
cransla tional mode floor reaction force ratio h, and further by 
adding the calculated value FO of the floor reaction force of 
the body position correcting perturbation model when it is 
assumed that the horizontal body position correcting 
perturbation model stabilization moment Mpf is zero. 

[0823] 

F:Ln = 1/h * Mpfdmd + Ffull + FO... Equation hl5 

[0624] 
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Subsequently, based on the corrected desired floor reaction 
force moment horizontal component without restriction Min and 
the corrected desired floor reaction force horizontal component 
v/ithout restriction Fin, a corrected desired floor reaction 
5 force moment horizontal component with restriction Mltd and a 
corrected desired floor reaction force horizontal component with 
restri ction Fltd (about a desired ZMP) , which are the values that 
have added restriction thereto, are determined by a restricting 
means (restriction processing unit) 211. In the present 

10 embodiment, a desired floor reaction force moment horizontal 
component for compliance control agrees with the corrected 
desireid floor reaction force moment horizontal component with 
restriction Mltd, and the floor reaction force horizontal 
component of a corrected gait agrees with a corrected desired 

15 floor reaction force horizontal component with restriction Fltd. 
[0825] 

Ttie corrected desired floor reaction force moment horizontal 
component with restriction Mltd and the corrected desired floor 
reaction force horizontal component with restriction Fltd are 

20 determined such that the true ZMP of the corrected gait (including 
the desired floor reaction force moment horizontal component for 
compliance control) falls within the aforesaid ZMP permissible 
range and the floor reaction force horizontal component of the 
corrected gait falls within a floor reaction force horizontal 

25 component permissible range. In other words, Mltd and Fltd are 
determined such that the ZMP restrictive condition and the floor 
reaction force horizontal component restrictive condition are 
satisfied. 
[C826] 

30 Furthermore, under the aforesaid restrictive condition, a 
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horizontal body position correcting perturbation model 
stabilization moment Mp is determined to agree with or 
approximate to the required value Mpfdmd of horizontal body 
position correcting perturbation model stabilization moment as 
much as possible. Similarly, a body posture inclination angle 
correcting perturbation model stabilization moment Mr is 
determined to be a value that agrees with or approximate to the 
required value Mrfdmd of body posture inclination angle 
correcting perturbation model stabilization moment as much as 
possible. This stabilizes the aforesaid correcting 

perturbation model body position Xc and the aforesaid correcting 
perturbation model body posture inclination angle Gc, thus 
preventing divergence . 
[0827] 

The details of the restricting means (restriction processing 
unit) 211 are given in PCT / JPO 3 / 0 0 4 3 5 previously proposed by the 
present applicant, so that further explanation will be omitted 
herein . 

[0828] 

Subsequently, according to the following equation, the 
horizontal body position correcting perturbation model 
stabilization moment Mpf and the body posture inclination angle 
correcting perturbation model stabilization moment Mrf are 
determined by an Mpf calculator 212 and an Mrf calculator 213, 
respectively . 

[0829] 

Mpf = (Fltd - Ffull - FO) ^ h... Equation h20 
[0830] 

Mrf Mltd - Mpf - Mdmdxy ... Equation h21 
10 8 31] 
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More specifically, the Mpf calculator 212 multiplies the 
value, which is obtained by subtracting the full-model floor 
reaction force horizontal component Ffull from the corrected 
desired floor reaction force horizontal component with 
restriction Fltd and subtracting therefrom the calculated value 
FO of the floor reaction force of the body position correcting 
perturbation model 202 in the case where Mp is assumed to be zero, 
by the body translational mode floor reaction force ratio h so 
as to obtain the horizontal body position correcting 
perturbation model stabilization moment Mpf . The Mrf calculator 
213 subtracts the aforesaid horizontal body position correcting 
perturbation model stabilization moment Mpf and the compensating 
total floor reaction force moment horizontal component Mdmdxy 
from the corrected desired floor reaction force moment 
horizontal component with restriction Mltd about the desired ZMP 
to obtain the body posture inclination angle correcting 
perturbation model stabilization moment Mrf. 
■08 32] 

Subsequently, according to the equations shown below, the 
horizontal body position correcting perturbation model floor 
reaction force moment Mp and the body posture inclination angle 
correcting perturbation model floor reaction force moment Mr are 
determined . 
[0833] 

Mp = Mpf - Mfull... Equation h22 

[0834] 

Mr = Mrf ... Equation h23 
[0835] 

This means that an Mp calculator 214 subtracts a full-model 
floor reaction force moment horizontal component Mfullxy from 
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the horizontal body position correcting perturbation model 
stabilizing moment Mpf to obtain the horizontal body position 
correcting perturbation model floor reaction force moment Mp . 
The body posture inclination angle correcting perturbation model 
floor reaction force moment Mr takes the same value as that of 
the body posture inclination angle correcting perturbation model 
stabil-izat^ion moment Mr f . 
[(3836] 

Subsequently, the horizontal body position correcting 
perturbation model floor reaction force moment Mp is supplied 
to the body position correcting perturbation model 202 in which 
the correcting perturbation model body position Xc balancing the 
supplied floor reaction force moment is calculated. 
[0837] 

Further, the body posture inclination angle correcting 
perturbation model floor reaction force moment Mr is supplied 
to the body posture inclination angle correcting perturbation 
model 203 in which the correcting perturbation model body posture 
inclination angle Gc balancing the supplied floor reaction force 
moment horizontal component is calculated. 
[0838] 

Subsequently, calculators 205 and 204 determine a corrected 
desired horizontal body position and a corrected desired body 
posture inclination angle according to the following Equation 
h24 and Equation h25, respectively, and the determined values 
are output as the final desired instantaneous values of the 
horizontal body position/posture. 
: 0 8 3 9 ] 

Corrected desired horizontal body position 

= Simplified model horizontal body position + Corrected 
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perturbation model body position Xc 
... Equation h24 
[0840] 

Corrected desired body posture inclination angle 
5 - Simplified model body posture inclination angle + Corrected 
perturbation model body posture inclination angle Be 

... Equation h25 
[08 41] 

In other words, the correcting perturbation model body 
10 position Xc is added to the simplified model horizontal body 
posit--on to obtain the corrected desired horizontal body 
posit.-.on, and this is output as a final desired horizontal body 
posit:,on. The correcting perturbation model body posture 
inclination angle Gc is added to the simplified model body posture 
15 inclination angle to provide the corrected desired body posture 
inclination angle, and this is output as a final desired body 
posture inclination angle. 
[ 0842 ] 

In addition, the corrected desired floor reaction force 
20 moment horizontal component with restriction Mltd is output as 
a desired floor reaction force moment horizontal component for 
compliance control about the desired ZMP, and a corrected desired 
floor reaction force horizontal component with restriction Fltd 
is output as a corrected desired floor reaction force horizontal 
25 component . 

[0843] 

More specifically, according to Equation h26 and Equation 
h27 shown below, the corrected desired floor reaction force 
horizontal component and the corrected desired floor reaction 
30 force mom.ent horizontal component about the desired ZMP are 
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cieterrrined as the final desired instantaneous values of the floor 
reaction force horizontal component and the floor reaction force 
moment horizontal component (the moment horizontal component 
about the desired ZMP) , respectively, and these are output. 
[0844] 

Desirt'd floor reaction force moment horizontal component for 

compli.ance control 

:= Corrected desired floor reaction force moment horizontal 
component with restriction Mltd 

... Equation h26 

[ 38451 

Corrected desired floor reaction force horizontal component 
= Corrected desired floor reaction force horizontal component 
with restriction Fltd 

... Equation h27 

[0846] 

The processing up to the above in S3536 is the same as that 
described in PCT/ JP03/00435 . 

Further, an antiphase arm swing angle correcting 
perturbation model moment Ma and a desired floor reaction force 
moment vertical component to be input to the antiphase arm swing 
angle correcting perturbation model are determined in the 
antiphase arm swing angle correcting perturbation model moment 
determiner. Then, an antiphase arm swing angle correcting 
perturbation model moment Ma is input to the antiphase arm swing 
angle correcting perturbation model to determine a correcting 
perturbation model antiphase arm swing angle Gca. 
[0847] 

Supplementally, the antiphase arm swing angle correcting 
perturbation model moment determiner determines a feedback 



amount (manipulation amount) according to a feedback control law 
on the basis of the state of the antiphase arm swing angle 
correcting perturbation model 231, such as the PI control, so 
that a corrected desired antiphase arm swing angle, that is, the 
arm swing angle obtained by adding a correcting perturbation 
model antiphase arm swing angle to a desired antiphase arm swing 
angle based on a simplified model, stcabilizes to or follows a 
reference antiphase arm swing angle (determined in S3404 of Fig. 
57) output by the desired instantaneous value generator 100b or 
a desired antiphase arm swing angle (obtained in S3414 of Fig. 
!37) based on a simplified model, and the determined feedback 
amount is additionally input to the antiphase arm swing angle 
correcting perturbation model 231. 
[08 48 1 

This control law is referred to as an antiphase arm swing 
angle correcting perturbation model control law 231, and the 
feedback amount (manipulation amount) is referred to as a 
required value Mafdmd of perturbation model stabilizing moment 
for correcting antiphase arm swing angle. The term ^^required 
value" has been added for the same reason as that for the required 
value Mpfdmd of perturbation model stabilizing moment for 
correcting horizontal body position. The moment corrected by 
adding restriction thereto is referred to as perturbation model 
stabilizing moment Maf for correcting antiphase arm swing angle. 
[0849] 

Specifically, the antiphase arm swing angle correcting 
perturbation model control law for determining the required 
value Mafdmd of perturbation model stabilizing moment for 
correcting antiphase arm swing angle is implemented according 
to the equation given below. 
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[0850] 

F:equired value Mafdmd of perturbation model stabilizing moment 
for correcting antiphase arm swing angle 

- Kap (Correcting perturbation model antiphase arm swing angle 

eca 

- (Reference antiphase arm swing angle - Desired antiphase 

arm swing angle based on simplified model)) 

Kav ^ Correcting perturbation model antiphase arm swing angular 
velocity dGca/dt 

Equation h30 

where Kap and Kav denote feedback control law gains. 

[08 51] 

In Equation h30, (Reference antiphase arm swing angle - 
Desired antiphase arm swing angle based on simplified model) may 
be replaced by zero. 

[ 0852 1 

Tne operation of the antiphase arm swing angle correcting 
perturbation model moment determiner will be explained in 
conjunction with Fig. 79 showing the functional block diagram 

thereof . 

[0853] 

First, as described above, the required value Mafdmd of 
perturbation model stabilizing moment for correcting antiphase 
arm swing angle is determined according to the antiphase arm swing 
angle correcting perturbation model control law 230a (Equation 
h30) . 

[0854] 

Subsequently, a floor reaction force moment vertical 
component perturbation amount Mpz resulting from the correction 
of a horizontal body position using the horizontal body position 
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correcting perturbation model is determined by a calculator of 
a floor reaction force moment vertical component perturbation 
amount Mpz resulting from a correction of a horizontal body 
posit ion . 

[08551 

Specifically, it is determined according to the following 
equat :-on . 

[0856 1 

Mpz = (Position of simplified model body mass point 

+ Correcting perturbation model body position Xc - Desired 

ZMP) 

* (Simplified model body mass point horizontal acceleration 
+ Correcting perturbation model body acceleration d2Xc/dt2) 

- (Simplified model body mass point position - Desired ZMP) 

* (Simplified model body mass point horizontal acceleration) 

. . Equation h31 
[0857 1 

Alternatively, the following equation approximating the 

above equation may be used. 
1 0858 ] 

Mpz Correcting perturbation model body position Xc 

* (Simplified model body mass point horizontal acceleration 

+ Correcting perturbation model body acceleration 

d2Xc/dt2 ; 

+ (Simplified model body mass point position - Desired ZMP) 

* Correcting perturbation model body acceleration d2Xc/dt2) 

... Equation h32 
[0859] 

Subsequently, if it is assumed that the antiphase arm swing 
angle correcting perturbation model stabilization moment Maf is 
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matched with the required value Mafdmd of antiphase arm swing 
angle correcting perturbation model stabilization moment, and 
a desired floor reaction force moment vertical component for 
compliance control as a desired floor reaction force moment 
vertical component about a desired ZMP is matched with the total 
sum of the compensating total floor reaction force moment 
vertical component Mdmdz, Maf, Mfullz, andMpz, while ignoring 
the aforesaid restrictive condition on floor reaction force 
moment vertical component, then the floor reaction force moment 
vertical component Minz generated about the desired ZMP is 
determined by a calculator. This floor reaction force moment 
vertical component is referred to as a corrected desired floor 
reaction force moment vertical component without restriction 
Minz. The corrected desired floor reaction force moment 
vertical component without restriction Minz is determined 
according to the following equation. 
[0860] 

Minz = Mafdmd + Mdmdz + Mfullz + Mpz ... Equation h33 

[0861] 

Ihis means that the corrected desired floor reaction force 
moment vertical component without restriction Minz is obtained 
by adding the required value Mafdmd of antiphase arm swing angle 
correcting perturbation model stabilization moment, the 
compensating total floor reaction force moment vertical 
component Mdmdz, the full-model floor reaction force moment 
vertical component Mfullz, and the horizontal body position 
correcting perturbation model moment vertical component Mpz. 
[0862] 

subsequently, based on the corrected desired floor reaction 
force moment vertical component without restriction Minz, a 
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corrected desired floor reaction force moment vertical component 
with restr iction Mltdz (about a desired ZMP) , which is the value 
that has added restriction thereto, is determined by a 
restricting means (restriction processing unit) . In the present 
embodiment, a desired floor reaction force moment vertical 
component for compliance control agrees with the corrected 
desired floor reaction force moment vertical component with 
restriction Mltdz. 
[0863] 

The corrected desired floor reaction force moment vertical 
component with restriction Mltdz is determined such that it falls 
within a floor reaction force moment vertical component 
permiBsibLe range. In other words, Mltdz is determined so that 
it sa-isfies a floor reaction force moment vertical component 
restrictive condition. 
[08 64] 

Furthermore, under the restrictive condition, the antiphase 
arm swing angle correcting perturbation model stabilization 
moment Ma is determined to agree with or be as close as possible 
to the required value Mafdmd of antiphase arm swing angle 
correcting perturbation model stabilization moment. This 
stabilizes the aforesaid correcting perturbation model 
antiphase arm swing angle Gca, thus preventing divergence. 
;0865] 

A restricting means (restriction processing unit) is a 
function having a saturation characteristic represented by the 
foll(3wing equation. 
[0866] 

If Minz > Upper limit value of a floor reaction force moment 
vertical component permissible range, then 
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Mltdz - Upper limit value of the floor reaction force moment 
vertical component permissible range. 

If Minz < Lower limit value of a floor reaction force moment 
vertical component permissible range, then 

Mltdz = Lower limit value of the floor reaction force moment 
vertical component permissible range. 

If the lower value of a floor reaction force moment vertical 
component permissible range < Minz, and Minz < Upper limit value 
of the floor reaction force moment vertical component 
permissible range, then 

Mltdz = Minz 

Equation h34 

[0867] 

Subsequentally, according to the equation shown below, an 
antiphase arm swing angle correcting perturbation model moment 
Ma is determined by a Maf calculator. 
[ D868 1 

Ma = Mltdz - (Mdmdz + Mfullz + Mpz)... Equation h35 

[0869] 

This means that in the Maf calculator, an antiphase arm swing 
angle correcting perturbation model moment Ma is obtained by 
subtraoting the compensating total floor reaction force moment 
vertical component Mdmdz, the full-model floor reaction force 
moment vertical component Mfullz, and the horizontal body 
position correcting perturbation model moment vertical 
component Mpz from the corrected desired floor reaction force 
moment vertical component with restriction Mltdz. 
[0870] 

Meanwhile, the corrected desired floor reaction force moment 
vertical component with restriction Mltd is output as the desired 
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floor reaction force moment vertical component for compliance 
control about a desired ZMP . 
[0871] 

More specifically, according to the following Equation h35, 
a corrected desired floor reaction force moment vertical 
component about the desired ZMP is determined as the final desired 
instantaneous value of the floor reaction force moment vertical 
component (the moment vertical component about the desired ZMP) , 
Hhese are output. 
[08 72] 

Desired floor reaction force moment vertical component for 

.3ompl iLance control 

:= Corrected desired floor reaction force moment vertical 
component with restriction Mltdz 

... Equation h36 

[0873] 

After the processing of the antiphase arm swing angle 
correcting perturbation model moment determiner is carried out 
as described above, the antiphase arm swing angle correcting 
perturbation model moment Ma is supplied to the antiphase arm 
swing angle correcting model shown in Fig. 66, and the correcting 
perturbation model antiphase arm swing angle Oca that balances 
with the supplied antiphase arm swing angle correcting 
perturbation model moment is calculated by using Equation a23c 
(by integrating) . 
:087()] 

subsequently, in the calculator, the corrected desired 
antiphase arm swing angle is determined according to the 
following Equation h37, and this is output as the final desired 
instantaneous value of the antiphase arm swing angle. 
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[ 0 3 "/ 5 ] 

Corrected desired antiphase arm swing angle 
= Simplified model antiphase arm swing angle 

+ Correcting perturbation model antiphase arm swing angle Oca 

... Equation h37 
[ C 8 7 6 1 

This means that the corrected desired antiphase arm swing 
angle is obtained by adding the correcting perturbation model 
antiphase arm swing angle 6ca to the simplified model antiphase 
arm swing angle, and this is output as the final desired antiphase 
arm swing angle. 
[ 0877 I 

Tne gait correction of S3536 is made as described above. 
[0878] 

supplementally, the present embodiment is the feedforward 
type correction, and the perturbation dynamic models are not 
precise models. For this reason, even if gaits are corrected 
so as to satisfy Equation h5. Equation h6, and Equation hl006, 
as described above, dynamic balance conditions are not satisfied 
in the strict sense although the dynamic balance conditions are 
approximately satisfied. 
: 0 8 7 9 J 

Furthermore, in the present embodiment, at the end of a 
one-step gait (the end of the current time gait), for example, 
the state amounts of the horizontal body position correcting 
perturbation model 202, the body posture inclination angle 
correcting perturbation model 203, and the antiphase arm swing 
angle correcting perturbation model 231, e.g., the horizontal 
position of the body mass point (the inverted pendulum mass point) 
of the horizontal body position correcting perturbation model 
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202, the rotational angle of the flywheel of the body posture 
inclination angle correcting perturbation model 203, and the 
rotational angle of the flywheel of the antiphase arm swing angle 
correcting perturbation model 231, are added as the state amount 
of the simplified model 200. In other words, the state amount 
of the simplified model 200 at the end of the current time gait 
is corrected to the state amount obtained by adding the body 
amotion of the horizontal body position correcting perturbation 
model 202 and the state amounts of the body posture inclination 
angle correcting perturbation model 203 and the antiphase arm 
swing angle correcting perturbation model 231. Further, the 
state amount of each of the perturbation models 202, 203, and 
231 is initialized (e.g., the horizontal position of the body 
mass point (the inverted pendulum mass point) of the horizontal 
body position correcting perturbation model 202, the rotational 
angle of the flywheel of the body posture inclination angle 
correcting perturbation model 203, and the rotational angle of 
the flywheel of the antiphase arm swing angle correcting 
perturbation model 231 are reset to zero). Then, a next time 
gait IS generated, taking the state amount of the simplified model 
200 that has been corrected as described above as the initial 
value of the next time gait, and the correcting perturbation model 
horizontal body position Xc, the correcting perturbation model 
body posture inclination angle ec, and the correcting 
perturbation model antiphase arm swing angle Bca of the 
individual perturbation models 202, 203, and 2 31 are calculated . 
This makes it possible to further enhance the stability of the 
behaviors of the individual perturbation models 202, 203, and 
231. The state amounts of the simplified model 200 described 
above may be corrected as necessary while a gait is being 



30 
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generated. Conversely, the correction of the state amounts of 
the simplified model 200 or the resetting of the perturbation 
models described above mtay not be carried out while a gait is 
being generated. 
5 [0880] 

The aforesaid correction of state amounts of the simplified 
model 200 will be implemented in the same manner in a fifth and 
a sixth embodiments, which will be discussed hereinafter. 

[0881] 

10 In the present embodiment, the aforementioned restoring 

conditions are all satisfied. Accordingly, the same operations 
and aovantages as those of the aforementioned third embodiment 

can be ob t a i ne d . 

[0882] 

15 E^urthermore, in addition to the operations and advantages 

of the third embodiment, the calculation volume can be reduced 
CO be relatively small when determining a horizontal body 
posit:.on, a body posture inclination angle, and an antiphase arm 
swing angle so that the aforementioned restoring conditions are 

20 satisfied. 

[ D883 1 

A fifth embodiment of the present invention will now be 
explained. The correcting technique of a device according to 
the f_\fth embodiment differs from that of the aforesaid fourth 

25 embodiment only in the processing of the gait generator 100 (the 
processing of S3536 of Fig. 65), and it is a full-model feedback 
correction type. It is a technique that uses an inverse dynamic 
full model (inverse full model), does not correct an input of 
a simplified model gait, and uses a perturbation model. 

30 [0884] 
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Fig. 74 is a functional block diagram explaining an operation 
ol the device according to the fifth embodiment^ specifically, 
the gait: correcting technique of S3536 of the flowchart of Fig. 
65. However, a simplified model 200 shown in Fig. 74 represents 
5 not only a dynamic model but also the processing from S3510 to 
S3532 of Fig. 65, i.e., the processing for calculating 
(determining) a simplified model gait instantaneous value, as 
in the case of the aforesaid third embodiment. Hence, in Fig. 
74, the portion beyond the simplified model 200 corresponds to 
10 the pr(3cessing of S3536. Of the functional portions in Fig. 74, 
like functional portions as those in Fig. 66 according to the 
fourth embodiment will be assigned like reference marks in Fig. 
66 and detailed explanation thereof will be omitted. 
[0885] 

15 Since the construction other than the processing of S3536 

is the same as that of the fourth embodiment, the explanation 
thereof will be omitted, and the following will explain the 
processing of S3536 in detail in conjunction with Fig. 74. 

[0886] 

20 In S3536, first, as previously described, a correcting 

perturbation model horizontal body position Xc, which will be 
discussed later, calculated at the last time control cycle (time 
t - At i is added by a calculator 205 to an instantaneous value 
of a desired horizontal body position of a simplified model gait 

25 determined in S3532 of Fig. 65, thereby determining a final 
desired horizontal body position (corrected desired horizontal 
body position) . Further, a correcting perturbation model body 
posture inclination angle 0c, which will be discussed later, 
calculated at the last time control cycle (time t - At) is added 

30 by a calculator 204 to an instantaneous value (a provisional 
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i ns tfin taneous value determined in the control cycle at current 
time 1.) of a desired body posture inclination angle of a 
simplified model gait determined in S3532 of Fig. 65, thereby 
determining a final desired body posture inclination angle 
5 (corrected desired body posture inclination angle). Further, 
a correcting perturbation model antiphase arm swing angle 9ca, 
which v/ill be discussed later, calculated at the last time control 
cycle (time t - At) is added by a calculator 232 to an 
instantaneous value (provisional instantaneous value determined 
10 in the control cycle at current time t) of a desired antiphase 
arm swing angle of a simplified model gait determined in S3532 
of Fig. 65, thereby determining a final desired antiphase arm 
swing angle (corrected desired antiphase arm swing angle). 
[ 0887 ] 

15 Then, these corrected desired horizontal body position, 

corrected desired body posture inclination angle, and corrected 
desired antiphase arm swing angle are output as the final desired 
instantaneous values of the horizontal body position, the body 
posture inclination angle, and the antiphase arm swing angle, 

20 respectively. 

[0888] 

More specifically, the corrected desired horizontal body 
position, the corrected desired body posture inclination angle, 
and the corrected desired antiphase arm swing angle are 
25 determined according to the aforesaid Equation h24. Equation h25, 
and Equation h37. 
[0889] 

Subsequently, the desired horizontal body position (the 
corrected desired horizontal body position) , the desired body 
30 posture inclination angle (the corrected desired body posture 
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inclination angle), and the desired antiphase arm swing angle 
(the corrected desired antiphase arm swing angle) obtained by 
correcting the simplified model gait as described above, and the 
instantaneous values of the motional variables, such as the 
desired (::enter-of -gravity position, the desired foot 
position/posture, and the^ desired arm posture, of the simplified 
model gait obtained as previously described, and the 
instantaneous value of the desired ZMP are input to the aforesaid 
inverse dynamic full model 201, and then the floor reaction force 
horizontal component and the floor reaction force moment about 
the desired ZMP (a horizontal component and a vertical component) 
that balance with the motion expressed by the input motional 
variables (i.e., that are generated by the inverse full model 
201 by the motion) are calculated. Thus, according to the 
present embodiment, in addition to the simplified model 
horizontal body position, body posture? inclination angle, and 
antiphase arm swing angle, the correcting perturbation model 
horizontal body position Xc, the correcting perturbation model 
body pc^stuire inclination angle 9c, and a correcting perturbation 
model cintiphase arm swing angle 9ca are also input to the inverse 
full model 201. Hereinafter, as in the fourth embodiment, the 
floor reaction force horizontal component, the floor reaction 
force moment horizontal component, and the floor reaction force 
moment vertical component calculated by the inverse full model 
201 will be referred to as a full-model floor reaction force 
horizontal component Ffullxy, a full-model floor reaction force 
moment horizontal component Mfullxy, and a full-model floor 
reaction force moment vertical component Mfullz. 
[0890] 

The full-model floor reaction force horizontal component 
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Ffull, is cutput as a corrected desired floor reaction force 
horizontal component (a final desired instantaneous value of the 
floor reaaction force horizontal component at the current time 
t) . 

5 [0891] 

More specifically, a corrected desired floor reaction force 
horizontal component is determined according to the equation 

given below and output. 
[0892] 

10 Corrected desired floor reaction force horizontal component = 
Full-model floor reaction force horizontal component Ffull 
... Equation h48 
[08 93] 

As can be seen from the above processing, according to the 

15 present embodiment, a full-model corrected gait is constituted 
by adding a behavior of the horizontal body position correcting 
perturbation model 202, a behavior of the body posture 
inclination angle correcting perturbation model 203, and a 
behavior of the antiphase arm swing angle correcting 

20 perturbation model 231 to a simplified model gait. Further, the 
equation shown below holds, considering that the floor reaction 
force horizontal component generated by the body inclination 
mode and the floor reaction force horizontal component generated 
by the antiphase arm swing mode are both zero. However, a 

25 simplified model floor reaction force horizontal component is 
the translational force horizontal component of the floor 
reaction force generated by a motion of a simplified model gait, 
the floor reaction force being calculated using the inverse full 
model 2 01. 

30 [08 94] 
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Full-model floor reaction force horizontal component Ffull 
- Simplified model floor reaction force horizontal component 
+ Horizontal body position correcting perturbation model floor 
reaction force horizontal component Fp 
5 ... Equation h51 

[0895] 

Subsequently, a required value Mpfdmd of horizontal body 
position correcting perturbation model stabilization moment is 
determined according to a horizontal body position correcting 

10 perturbation model control law 206. The horizontal body 
position correcting perturbation model control law 206 in the 
present embodiment is set as proposed by the present applicant 
in Japanese Patent Application No. 2001-133621. For example, 
the ccntrcl law 206 is determined according to the following 

15 equation. 

[C896] 

Required value Mpfdmd of horizontal body position correcting 
perturbation model stabilization moment 
= Kpg ^ Difference in center of gravity + Kvg * Correcting 

20 perturbation model horizontal body velocity dXc/dt 
... Equation h52 

where the difference in center of gravity is determined 
according to the following equation. 
[08 97 J 

25 Difference in center of gravity = Horizontal position of 
full-rr.odel center of gravity - Horizontal position of simplified 

model center of gravity 
... Equation h53 
[08 98] 

:>0 where Kpg and Kvg in Equation h52 denote the gains of a 
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feedback control law, the horizontal position of full-model 
center of gravity, the horizontal position of simplified model 
center of gravity, and the correcting perturbation model 
horizontal body velocity dXc/dt are the horizontal position of 
the center of gravity of a full- model gait instantaneous value, 
the horizontal position of the center of gravity of a simplified 
model gait instantaneous value (a center-of -gravity horizontal 
position XGs calculated using a simplified model on the basis 
of an instantaneous posture of a simplified model gait), and a 
correcting perturbation model horizontal body velocity dXc/dt, 
respectively, which are calculated last time (time t - At) , as 
it wi],l be discussed later. 
[0899] 

More specifically, a perturbation model control feedback 
amount (manipulated variable) is calculated on the basis of the 
difference in center of gravity obtained by subtracting the 
center-of-gravity horizontal position of a simplified model from 
the center-of-gravity horizontal position of a full model and 
a perturbation model body velocity, which is one of the state 
amoun-zs of a perturbation model. Such a perturbation model 
control law makes it possible to control the temporal average 
value of the difference in center of gravity to substantially 
zero . 

[0900] 

Subsequently, a required value Mrfdmd of a body posture 
correcting perturbation model stabilization moment is 
determined according to a body posture xnclination angle 
correcting perturbation model control law 207 . For this purpose, 
the scime control law as that in the fourth embodiment may be used. 
Thus, as the control law 207, the aforesaid Equation hll, for 
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exampL::^, may be used. 
[ 0 9 0 1 J 

Subsequently, a corrected desired floor reaction force 
moment without restriction Min is determined (estimated) by a 
Min calculator 209. As in the fourth embodiment, the corrected 
desired floor reaction force moment without restriction Min is 
the floor reaction force moment horizontal component generated 
about a desired ZMP when a horizontal body position correcting 
perturbation model stabilization moment Mpf is matched with the 
required value Mpfdmd of horizontal body position correcting 
perturbation model stabilization moment, a body posture 
inclination angle correcting perturbation model stabilization 
moment Mrf is matched with the required value Mrfdmd of body 
posture inclination angle correcting perturbation model 
stabilization moment, and a desired floor reaction force moment 
horizontal component for compliance control as a desired floor 
reaction force moment about a desired ZMP is matched with the 
total sum of a compensating total floor reaction force moment 
horizontal component Mdmdxy, Mpf, and Mrf, while ignoring the 
aforesaid restriction (the ZMP restrictive condition and the 
floor reaction force horizontal component restrictive 
condition) . 
[C902] 

A corrected desired floor reaction force moment horizontal 
component without restriction Min is determined by the 
calculation according to the aforesaid Equation hl3, as in the 
fourth embodiment. More specifically, the corrected desired 
floor reaction force moment horizontal component without 
restriction Min is obtained by adding the required value Mpfdmd 
of horizontal body position correcting perturbation model 
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stabilization moment, the required value Mrfdmd of body posture 
inclination angle correcting perturbation model stabilization 
moment, and the total sum of a compensating total floor reaction 
force moment horizontal component Mdmdxy . 
[0903] 

Furthermore, a corrected desired floor reaction force 
horizontal component without restriction Fin is also determined 
(estimated) by a Fin calculator 210. As in the fourth embodiment, 
the corrected desired floor reaction force horizontal component 
without restriction Fin is the floor reaction force horizontal 
component (corresponding to Ffull) generated by the inverted 
full model 201 when the horizontal body position correcting 
perturbation model stabilization moment Mpf is matched with the 
required value Mpfdmd of horizontal body position correcting 
perturbation model stabilization moment, the body posture 
inclination angle correcting perturbation model stabilization 
moment Mrf is matched with the required value Mrfdmd of body 
posture inclination angle correcting perturbation model 
stabilization moment, and the desired floor reaction force 
moment: horizontal component for compliance control is matched 
with the total sum of the compensating total floor reaction force 
moment horizontal component Mdmdxy, Mpf, and Mrf , while ignoring 
the aforesaid restriction (the ZMP restrictive condition and the 
floor reaction force horizontal component restrictive 
condition) . 
[ 0 904 ] 

Un.like the fourth embodiment, the corrected desired floor 
reaction force horizontal component without restriction Fin is 
determined according to the following equation. 
[ 09051 
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Correct63d desired floor reaction force horizontal component 
without restriction Fin 

= Full-model floor reaction force horizontal component Ffull 
+ 1/h 

5 ^ (Required value Mpfdmd of horizontal body position correcting 

perturbation model stabilization moment 

- Horizonral body position correcting perturbation model 
stabilization moment Mpf) 
... Equation h54 
10 [0906] 

where the horizontal body position correcting perturbation 
model stabilization moment Mpf uses a last time value (the value 
at time t - At) . More specifically, the difference between the 
required value Mpfdmd of horizontal body position correcting 

15 perturbation model stabilization moment and the horizontal body 
position correcting perturbation model stabilization moment Mpf 
is determined, and the amount of an increase in a full-model floor 
reaction force horizontal component Ffull resulting from 
increa.sing the input of the horizontal body position correcting 

20 pertuibation model by the above difference is estimated by 
dividi.ng the above difference by a body trans lational mode floor 
reaction force ratio h. Further, the full-model floor reaction 
force horizontal component Ffull is added thereto so as to 
estimate the corrected desired floor reaction force horizontal 

25 component without restriction Fin. 
[ 0907 ] 

Subsequently, based on the corrected desired floor reaction 
force moment horizontal component without restriction Min and 
the corrected desired floor reaction force horizontal component 
30 without restriction Fin, a corrected desired floor reaction 
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force Tiomeat horizontal component with restriction Mltd and a 
corrected ciesired floor reaction force horizontal component with 
restriction Fltd (about a desired ZMP) , which are the values that 
have added restriction thereto^ are determined by a restricting 
5 means ( res::r ict ion processing unit 211) similar to that in the 
fourth embodiment such that the aforesaid restrictions (the ZMP 
restrictive condition and the floor reaction force horizontal 
component restrictive condition) are satisfied. This 
processing technique is the same as that in the fourth embodiment . 
10 [0908] 

In the present embodiment also, the desired floor reaction 
force moment horizontal component for compliance control is 
matched with the corrected desired floor reaction force moment 
horizontal component with restriction Mltd, and the corrected 

15 desired floor reaction force horizontal component substantially 
agrees with the corrected desired floor reaction force 
horizontal component with restriction Fltd; therefore, the 
desired floor reaction force moment horizontal component for 
compliance control and the corrected desired floor reaction 

20 force horizontal component substantially satisfy the ZMP 
restrictive condition and the floor reaction force horizontal 
component restrictive condition by determining the corrected 
desired floor reaction force moment horizontal component with 
restriction Mltd and the corrected desired floor reaction force 

25 horizontal component with restriction Fltd as described above. 
[0909] 

Subsequently, the horizontal body position correcting 
perturbation model stabilization moment Mpf is determined by an 
Mpf calculator 215. More detailedly, the value obtained by 
30 multiplying the value, which is obtained by subtracting the 
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full-model floor reaction force horizontal component Ffull from 
the corrected desired floor reaction force horizontal component 
with restriction Fltd, by the gain Kc is integrated by an 
integrator 215a, and further, the obtained integrated value is 
multiplied by the body translational mode floor reaction force 
ratio h to determine the horizontal body position correcting 
perturbation model stabilization moment Mpf . In other words, 
the horizontal body position correcting perturbation model 
stabilization moment Mpf is obtained according to the following 
equation . 

[0910] 

Mpf - h * J Kc(Fltd - Ffull) dt ... Equation h55 

[ C 9 1 1 ] 

Subsequently, by an Mrf calculator 214, the body posture 
inclination angle correcting perturbation model stabilization 
moment Mrf is determined by subtracting the horizontal body 
position correcting perturbation model stabilization moment Mpf 
and the compensating total floor reaction force moment 
horizontal component Mdmdxy from the corrected desired floor 
2:eaction force moment horizontal component with restriction Mltd. 
In other words, the body posture inclination angle correcting 
perturbation model stabilization moment Mrf is obtained 
accoroing to the aforesaid Equation h21. 

[0912] 

Furthermore, according to the aforesaid Equation h23, the 

body p)Osture inclination angle correcting perturbation model 
floor reaction force moment Mr is determined. In other words, 
the body posture inclination angle correcting perturbation model 
stabi].ization moment Mrf, which is an output of the Mrf calculator 
214, is directly determined as the body posture inclination angle 
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correctxng perturbation model floor reaction force moment Mr. 
[0913] 

Subsequently, a full-model floor reaction force moment error 
Merr defined by the following equation is calculated by a Merr 
calculator 216. 

[ C 9 1 4 ] 

E'ull-rrodel floor reaction force moment error Merr 

- Full-model floor reaction force moment horizontal component 
Mf ullxy 

- Corrected desired floor reaction force moment horizontal 
component with restriction Mltd 
... Equation h56 

[0915] 

Subsequently, an Mp calculator 217 determines the horizontal 
body position correcting perturbation model floor reaction force 
moment Mp according to the following equation. 

[0916] 

Mp - Mpf - J" Km^Merr dt ... Equation h57 

[ t') 9 1 7 ] 

This means that the value obtained by multiplying the 
full-model floor reaction force moment error Merr by an 
integration gain Km is integrated by the integrator 217a, and 
the sign of the integrated value is reversed. Further, the 
outpur of the integrator 217a is added to the horizontal body 
position correcting perturbation model stabilization moment Mpf 
to determine the horizontal body position correcting 
perturbation model floor reaction force moment Mp . 
[0918 ] 

Subsequently, the horizontal body position correcting 
perturbation model floor reaction force moment Mp is "supplied 
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to the body position correcting perturbation model 202, and a 
correcting perturbation model body position Xc that balances 
with the supplied floor reaction force moment horizontal 
component is calculated. 
5 [0919] 

In addition, the body posture inclination angle correcting 
perturbation model floor reaction force moment Mr is supplied 
to a body posture inclination angle correcting perturbation 
m.odel 203, and the correcting perturbation model body posture 
10 inclination angle Qc that balances with the supplied floor 
reaction force moment horizontal component is calculated. 
[C920] 

Tte processing up to the above in S3536 is as per 
PCT/ JP03 /00435 . Further, an antiphase arm swing angle moment 
15 correcting perturbation model Ma is determined in the antiphase 
arm sw Lng angle correcting perturbation model moment determiner . 
[0921] 

Furthermore, the antiphase arm swing angle correcting 

perturbation model moment Ma is input to an antiphase arm swing 
20 angle correcting perturbation model to determine a correcting 
perturbation model antiphase arm swing angle Gca . 
[ 0922 J 

The following will explain in detail the operation of the 
antiphase arm swing angle correcting perturbation model moment 
25 determiner in conjunction with Fig. 80, which is a functional 
block diagram thereof. 

[0923 I 

First, the required value Mafdmd of antiphase arm swing angle 
correcting perturbation model stabilization moment is 
30 determined according to an antiphase arm swing angle correcting 
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perturbation mode], control law. For this purpose, the same 
control law as that in the fourth embodiment may be used. Thus, 
as the control law, the aforesaid Equation h30, for example, may 
be used . 

[0924] 

Subsequently, a corrected desired floor reaction force 
moment vertical component without restriction Minz is determined 
by subtraccing the last time value (an output of an integrator, 
which will be discussed later) of the antiphase arm swing 
correcting perturbation model moment Ma from the sum of the 
full-model floor reaction force moment vertical component Mfullz, 
the compensating total floor reaction force moment vertical 
component Mdmdz, and the required value Mafdmd of antiphase arm 
swing angle correcting perturbation model stabilization moment . 
Then, a restriction is added to the corrected desired floor 
reaction force moment vertical component without restriction 
Minz so that it does not exceed a floor reaction force vertical 
component moment permissible range (that is, passing it through 
a shown saturation characteristic function) , thereby 
determining the corrected desired floor reaction force moment 
vertical component with restriction Mltdz. Next, the value 
obtained by subtracting the sum of the full-model floor reaction 
force moment vertical component Mfullz, the compensating total 
floor reaction force moment vertical component Mdmdz, and the 
required value Mafdmd of antiphase arm swing angle correcting 
perturbation model stabilization moment from the corrected 
desir€id floor reaction force moment vertical component with 
restriction Mltdz is integrated using an integration gain Ka so 
as to determine the antiphase arm swing correcting perturbation 
model moment Ma, which is output. In addition, the corrected 
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desired floor reaction force moment vertical component with 
restriction Mltdz is output as the desired floor reaction force 
moment vertical component for compliance control. 

The antiphase arm swing correcting perturbation model moment 
Ma and the desired floor reaction force moment vertical component 
for compli^:ince control are determined in the antiphase arm swing 
angle correcting perturbation model moment determiner as 
described above. 

[0925] 

The determined correcting perturbation model body position 
Xc, the correcting perturbation model body posture inclination 
angle 6c, the correcting perturbation model antiphase arm swing 
angle 9ca, the horizontal body position correcting perturbation 
model stabilization moment Mpf, and the antiphase arm swing 
correcting perturbation model moment Ma are used as the last time 
values at the next time control cycle (time t + At) as previously 
described . 

[0926] 

The rest of the construction and processing are the same as 
those of the fourth embodiment. According to the fifth 
embodiment, the same operations and advantages as those of the 
fourth embodiment can be obtained. 

[0927] 

A sixth embodiment according to the present invention will 
now be explained with reference to Fig. 75 and Fig. 76. The sixth 
embodiment is based on a technique that generates a gait while 
correcting the gait by using a forward dynamic model (to be more 
precise, a pseudo forward dynamic model) in place of the inverse 
dynamic full model (inverse full model) 201 used in the 
aforementioned fourth and fifth embodiments. 
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[0928] 

Fiq . 7 b is a functional block diagram explaining an operation 
of a de^vice according to the fifth embodiment. As shown in Fig. 
75^ thes present embodiment is provided with a pseudo forward full 
model (pseudo forward dynamic full model) 222. 

[0929] 

The pseudo forward full model 222 receives the required value 
Mpfdmd of horizontal body position stabilization moment, the 
required value Mrfdmd of body posture inclination angle 
stabilization moment, the required value Mafdmd of antiphase arm 
swing angle stabilization moment, a desired ZMP, a desired floor 
reaction force vertical component, a compensating total floor 
reaction force moment horizontal component Mdmdxy, a 
compensating total floor reaction force moment vertical 
component Mdmdz, and the motional states of parts excluding a 
body 3, such as desired foot position/posture and a desired arm 
posture, and outputs a desired vertical body position, a desired 
horizontal body position, a desired body posture inclination 
angle, a desired antiphase arm swing angle, a desired floor 
reaction fvorce moment (a horizontal component and a vertical 
component) for compliance control as the desired floor reaction 
force Tioment about a desired ZMP,, and a desired floor reaction 
force horizontal component. A desired value input of the pseudo 
forward full model 222 is generated by a desired instantaneous 
value generator 100b on the basis of a gait parameter determined 
by a gait parameter determiner 100a, as explained with reference 
to the aforesaid Fig. 64. 

[0930] 

Specifically, the above pseudo forward full model 222 is 
represented by the functional block diagram of Fig. 76. In this 
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functional block diagram, the same functional parts as those in 
E'iq. 7.4 of rhe aforementioned fourth embodiment will use the same 
reference marks as those in Fig. 74. 
[ C 9 3 1 ] 

A simplified model 200 in Fig. 76 represents not merely 
represents a dynamic models but it also represents the processing 
from S3510 to S3532 of Fig. 65 described above, namely, the 
processing for calculating (determining) a simplified model gait 
instantaneous value . Further, in the processing for calculating 
(determining) a current time gait instantaneous value (the gait 
instar taneous value of a simplified model ) inS3532, as explained 
in the above fourth embodiment, the instantaneous value of a gait 
is generated, setting the model manipulation floor reaction 
force moment horizontal component about a desired ZMP to zero, 
then a per turbational motion of a body inclination mode that 
generates a simplified gait body posture inclination angle 
correc:ting moment Mr (last time value) , which corresponds to the 
body p)Osture inclination angle correcting perturbation model 
moment. Mr described in the fourth embodiment, a per turbational 
motion of a body t ranslat ional mode that generates a simplified 
model horizontal body position correcting moment Mp (last time 
value), which corresponds to the horizontal body position 
correc:ting perturbation model moment Mp described in the fourth 
embodiment, and a per turbational motion of an antiphase arm swing 
mode that generates a simplified model antiphase arm swing angle 
correc:ting moment Ma (last time value) , which corresponds to the 
antiphase arm swing angle correcting perturbation model moment 
Ma described in the third embodiment are added thereto. Thus, 
the instantaneous value of a gait output by the simplified model 
20 0 is corrected. 
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[ 0 9 3 2 ] 

To explain more specifically, in the processing of S3532 of 
Fig. 65 in the present embodiment, the body horizontal 
acceleration obtained by adding, as a perturbational portion, 
5 a body horizontal acceleration (d2Xb/dt2) determined according 
to an e^quation in which the second term of the right side of the 
aforesaid P^.quation 03y is equal to Mp (last time value) , namely, 
the equation of Mp=mb ^ ( Zb- Z zmp ) ^ ( d2Xb /dt 2 ) , to the body 
horizontal acceleration determined by the simplified model 200 

10 is integrated to the second order from the beginning of the 
current time gait to current time t, thereby determining the 
instantaneous value of the horizontal body position at the 
current time t in S3414 and S3416 of Fig. 57, which constitute 
subroutine processing thereof. Furthermore, in S3414 of Fig. 

15 57, the body posture inclination angular acceleration obtained 
by adding, as a perturbational portion, a body posture 
inclination angular acceleration (d2eby/dt2) determined 
according to an equation in which the seventh term of the right 
side of the aforesaid Equation 03y is equal to Mr (last time value) , 

20 namely, the equation of Mr = J^d2 Oby /dt 2 , to the body posture 
inclination angular acceleration determined by the simplified 
model 200 is integrated to the second order from the beginning 
of the current time gait to the current time t, thereby 
determining the instantaneous value of the body posture 

25 inclination angle at the current time t. Furthermore, in S3414 
of Fig . 57 , the antiphase arm swing angular acceleration obtained 
by adding, as a perturbational portion, an antiphase arm swing 
angular acceleration (d2eaz/dt2) determined according to an 
equation in which the eighth term of the right side of the 

30 aforesaid Equation 03z is equal to Ma (last time value) , namely. 
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the equation of Ma- Jaz ^d2eaz /dt2 , to the antiphase arm swing 
angular acceleration determined by the simplified model 200 is 
integrated to the second order from the beginning of the current 
time gait to the current time t, thereby determining the 
5 instantaneous value of the antiphase arm swing angle at the 
current time t. 
[C933] 

Supplementally, for the horizontal body position and the 
body posture inclination angle, the description has been given 
10 of the instantaneous values on a lateral plane; however, the 
instantaneous values on a sagittal plane are also determined in 
the same manner. 
[ 0934 ] 

In Fig. 76, the portion beyond the simplified model 200 is 
15 the portion that carries out the processing that corresponds to 
the processing of S3536. The processing in S3536 will be 
explained in detail in conjunction with Fig. 76. 

[0935] 

In S3536, first, the simplified model horizontal body 
20 position that has been corrected on the basis of the simplified 
model horizontal body position correcting moment Mp (to be 
specific, the last time value in the control cycle at time (t-At) ) 
as described above is output as a desired horizontal body position 
(a final desired instantaneous value of the horizontal body 
25 position at time t) in S3032 . Furthermore, a simplified model 
body posture inclination angle that has been corrected on the 
oasis of a simplified model body posture inclination angle 
correcting moment Mr (to be specific, the last time value in the 
control cycle at time (t-At) ) is output as a desired body posture 
30 inclination angle (a final desired instantaneous value of the 
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body f^osture inclination angle at time t) . Furthermore, a 
simplified model antiphase arm swing angle that has been 
corrected on the basis of a simplified model antiphase arm swing 
angle ::orrecting model moment Ma (to be specific, the last time 
value in the control cycle at time (t-At) ) is output as a desired 
antiphase arm swing angle (a final desired instantaneous value 
of the antiphase arm swing angle at time t). 
[0936] 

Mere specifically, the final desired horizontal body 
position and desired body posture inclination angle are 
determined according to Equation hlOO, Equation hlOl, and 
Equation hl02. 

[C937] 

Desired horizontal body position = Simplified model 
horizontal body position ... Equation hlOO 
[C938] 

Desired body posture inclination angle = Simplified model 
body posture inclination angle ... Equation hlOl 

[ C 9 3 9 ] 

Desired antiphase arm swing angle = Simplified model 
antiphase arm swing angle ... Equation hl02 
[0940] 

Subsequently, the desired horizontal body position (i.e., 
the simplified model horizontal body position) , the desired body 
posture inclination angle (i.e., the simplified model body 
posture inclination angle), the desired antiphase arm swing 
angle (i.e., the simplified model antiphase arm swing angle), 
and the instantaneous values of the motion variables, such as 
the desired total center-of -gravity position, the desired foot 
position/posture, and the desired arm posture of the simplified 
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model gait, and the instantaneous value of the desired ZMP 
obtained as described above are input to the aforesaid inverse 
dynamic full model (inverse full model) 201, and then a floor 
reaction force horizontal component and a floor reaction force 
5 moment -a horizontal component and a vertical component) about 
the desired ZMP that balance with the motion represented by the 
input motional variables (i.e., generated by the inverse full 
model 201 by the motion) are calculated. Thereafter, as in the 
fifth embodiment, these calculated floor reaction force 

10 horizontal component, the floor reaction force moment horizontal 
component, and the floor reaction force moment vertical 
component will be referred to as a full-model floor reaction force 
horizontal component Ffull, the full-model floor reaction force 
moment horizontal component Mfullxy, and the floor reaction 

15 force moment vertical component Mfullz. 
[ C 9 4 1 ] 

As in the fifth embodiment, the full-model floor reaction 
force horizontal component Ffull is output as a desired floor 
reaction force horizontal component (a final desired 

20 instantaneous value of the floor reliction force horizontal 
component at time t) . 
[C942] 

The present embodiment is not provided with a body posture 
inclination angle correcting perturbation model, a horizontal 

25 body position correcting perturbation model, and an antiphase 
arm swing angle correcting perturbation model. Therefore, the 
processing that corresponds to the horizontal body position 
correcting perturbation model control law, the body posture 
inclination angle correcting perturbation model control law, and 

30 the aritiphase arm swing angle correcting perturbation model 
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control law is different from that in the fifth embodiment, as 
it will be discussed later. 
[0943] 

Except for this, after the aforesaid processing, the same 
processing as that for determining the body posture inclination 
angle correcting perturbation model moment Mr, the horizontal 
body position correcting perturbation model moment Mp, and the 
antiphase arm swing angle correcting perturbation model moment 
Ma in che fifth embodiment is carried out until the simplified 
model oody posture inclination angle correcting moment Mr, the 
simplified model horizontal body position correcting moment Mp, 
and the simplified model antiphase arm swing angle correcting 
moment Ma are determined. In other words, the processing of a 
Min calculator 209, a Fin calculator 210, a restriction 
processing unit 211 (restricting means) , an Mpf calculator 215, 
a Merr calculator 216, an Mrf calculator 217 (= Mr calculator), 
an Mp calculator 214, and an Ma calculator is the same as that 
in the fifth embodiment. In the present embodiment, Mr, Mp and 
Ma correspond to the body posture inclination angle correcting 
perturbation model moment Mr, the horizontal body position 
correcting perturbation model moment Mp , and the antiphase arm 
swing angle correcting perturbation model moment Ma, 
respectively, in the fifth embodiment; however, they are not 
input ~o perturbation models as in the fifth embodiment, but they 
are input to the simplified model 200. For this reason, the Mr, 
Mp and Ma are referred to as the simplified model body posture 
inclination angle correcting moment, the simplified model 
horizontal body position correcting moment, and the simplified 
model antiphase arm swing angle correcting moment. 

[C944] 
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The simplified model body posture inclination angle 
correcting moment Mr, the simplified model horizontal body 
position correcting moment Mp, and the simplified model 
antiphase arm swing angle correcting moment Ma determined as 
5 described above are used as last time values when determining 
(generating) simplified model gait instantaneous values at the 
next time control cycle (time t + At), as previously described. 
[0945] 

The rest of the construction and processing is the same as 
10 that of the fifth embodiment. 

[0946] 

The following will explain the processing for determining 
the required value Mrfdmd of body posture inclination angle 
stabilization moment, the required value Mpfdmd of horizontal 
i5 body position stabilization moment, and the required value 
Mafdmd of antiphase arm swing angle stabilization moment with 
reference to Fig. 75. 
[0947] 

As shown in Fig. 75, the present embodiment is provided with 
20 a simplified model 223 separate from the simplified model 200 
provided in the pseudo forward full model 222, as previously 
mentioned. The function of the simplified model 223 in the 
present embodiment is identical to that of the aforesaid 
simplified model 200, and the simplified model 223 represents 
25 not only a dynamic model but also the processing from S3510 to 
S3532 of Fig. 65 described above, i.e., the processing for 
calculating (determining) simplified model gait instantaneous 
values. The s impl i f led mode 1 223, in actual operation, does not 
necessarily have to perform all processing from S3510 to S3532 
30 of Fig. 60, as long as it is capable of determining the 
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ins te:in taneous values of body posture inclination angles and the 
instantaneous values of horizontal body positions. 
[0948] 

The following will explain in detail the processing for 
5 determining Mpfdmd and Mrfdmd in the present embodiment in 
conjunction with Fig. 75. 

[0949] 

In the present embodiment, the differences in the horizontal 
body position, the body posture inclination angle, and the 

10 antiphase arm swing angle between the gaits generated using the 
simplified model 223 and the gaits calculated as described above 
using the aforesaid pseudo forward dynamic full model 222 are 
determined by calculators 224 , 225 and 228. Then, based on these 
differences, the required value Mpfdmd of horizontal body 

15 position stabilization moment, the required value Mrfdmd of body 
posture inclination angle stabilization moment, and the required 
value Mafdmd of antiphase arm swing angle stabilization moment 
are determined by a feedback control law, such as PID, so as to 
converge the differences to zero. More specifically, Mpfdmd is 

20 determined by a horizontal body position stabilization control 
law 226 composed of a feedback control law on the basis of the 
difference between the horizontal body position by the 
simplified model 223 and the horizontal body position by the 
pseudo forward full model 222. Further, Mrfdmd is determined 

25 by a body posture inclination angle stabilization control law 
227 composed of a feedback control law on the basis of the 
difference between the body posture inclination angle by the 
simplified model 223 and the body posture inclination angle by 
the pseudo forward full model 222 . Further, Mafdmd is determined 

30 by an antiphase arm swing angle stabilization control law 
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composed of a feedback control law on the basis of the difference 
between the antiphase arm swing angle by the simplified model 
22 3 anci the antiphase arm swing angle by the pseudo forward full 
m.odel 222. Then, the determined Mpfdmd, Mrfdmd and Mafdmd are 
fed ba<::k and input to the aforesaid pseudo forward dynamic full 
mode 1 . 

[0950] 

In the present embodiment, the gait generator 100 outputs, 
as the final desired instantaneous values of a current time gait, 
a desired ZMP, a desired floor reaction force vertical component, 
desired foot position/posture, and a desired arm posture or the 
like, ^hlch are some of inputs to the aforesaid pseudo forward 
dynamic full model 222, and a desired vertical body position, 
a desired horizontal body position, a desired body posture 
inclination angle, a desired antiphase arm swing angle, a desired 
floor reaction force horizontal component, and a desired floor 
reaction force moment (a horizontal component and a vertical 
component) for compliance control, which are outputs from the 
aforesaid pseudo forward dynamic full model 222. 

[0951] 

The sixth embodiment explained above is capable of providing 
the operations and advantages similar to those of the 
aforementioned fifth embodiment. 

[0952] 

In the aforementioned fifth embodiment, the required value 
Mrfdmd of body posture inclination angle stabilization moment, 
the required value Mpfdmd of horizontal body position 
stabilization moment, and the required value Mafdmd of antiphase 
arm swi.ng angle stabilization moment have been input only to the 
pseudo forward full model 222. Alternatively, however, Mrfdmd, 
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Mpfdmd and Mafdmd may be input to the simplified model 223 or 
they may be divided and supplied to the simplified model 223 and 
the pseudo forward full model 222. 
[0953] 

5 A seventh embodiment of the present invention will now be 

explained with reference to Fig. 77. Fig. 77 is a functional 
block diagram illustrating the operation of a device according 
to the sixth embodiment of the present invention, specifically, 
a gait correcting technique in S3536 of the flowchart of Fig. 

10 65. Incidentally, in Fig. 77, the same functional parts as those 
in the fourth embodiment or the fifth embodiment will use the 
same reference marks as those in Fig. 66 or Fig. 74. 
[0954] 

The seventh embodiment is provided with a horizontal body 
15 position correcting perturbation model 202, a body posture 

inclination angle correcting perturbation model 203, and an 

antiphase arm swing angle correcting perturbation model 231. 

The sj.xth embodiment is provided also with three distributors 

22 0, 221, and 241. 
20 [0955 1 

The distributors 220, 221, and 241 are all defined as 1-input, 
2-output transmission blocks, and they are transmission blocks 
that determine one output on the basis of an input (e.g., signal 
processing of a frequency characteristic, a dead-zone 
25 characteristic, a saturation characteristic, or the like is 
carried out on an input to determine one output) and determine 
the other output such that the sum of the two outputs agrees or 
substantially agrees with the input. 
[0956] 

30 ft body posture inclination angle correcting moment Mr, which 
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IS the v.alue (an output of an Mr calculator 214) obtained by 
subt lact i ng a horizontal body position correcting perturbation 
modeJ. stabilization moment Mpf and a compensating total floor 
react. ion force moment horizontal component Mdmdxy from a 
5 corre^cted desired floor reaction force moment horizontal 
component with restriction Mltdxy, is supplied to the 
disti^ibutor 220, and divided into a body posture inclination 
angl€^ correcting perturbation model input Mri to be supplied to 
the body posture inclination angle correcting perturbation model 

10 203 and a simplified model body posture inclination angle 
correcting moment Mrs to be supplied to the simplified model 200 . 
At this time, the body posture inclination angle correcting 
perturbation model input Mri and the simplified model body 
posture inclination angle correcting moment Mrs are determined 

15 (outf)ut) such that the sum of the body posture inclination angle 
corr63Cting perturbation model input Mri and the simplified model 
body posture inclination angle correcting moment Mrs agrees with 
the t)ody posture inclination angle correcting moment Mr. 
.095^.^ ] 

20 t'o be more specific, the body posture inclination angle 

corre^cting perturbation model input Mri is determined on the 
basis; of the body posture inclination angle correcting moment 
Mr. For example, the body posture inclination angle correcting 
moment Mr is subjected to the processing of signals having a 

25 dead-zone characteristic, a saturation characteristic or a 
frequency characteristic so as to determine body posture 
inclination angle correcting perturbation model input Mri, The 
resuJ.t obtained by subtracting the body posture inclination 
angle? correcting perturbation model input Mri from the body 

30 posture inclination angle correcting moment Mr is determined as 
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the simplified model body posture inclination angle correcting 
moment Mrs. To explain more specifically, in the present 
embodiment, the distributor 220 outputs a low- frequency 
component (DC component) , which is obtained by passing an input 
5 (Body posture inclination angle correcting moment Mr 
-Mltd-Mpf-Mdmdxy ) through a low-pass filter, as a simplified 
mode] body posture inclination angle correcting moment Mrs, and 
also outputs the component obtained by subtracting Mrs from the 
input, (body posture inclination angle correcting moment Mr) as 

10 the body posture inclination angle correcting perturbation model 
input, Mri. In this case, the dead-zone characteristic is 
impai'ted to the simplified model body posture inclination angle 
corre^cting moment Mrs, which is the low-frequency component (DC 
component.), such that, in a state wherein an output of the 

!5 low-pass filter lies within a predetermined range centering 
around a certain predetermined value, the Mrs is maintained at 
that predetermined value (e.g., zero). 
: 0958 ] 

"""he body posture inclination angle correcting perturbation 
20 modeJ- inp-ut Mri, which is an output of the distributor 220, is 
suppj.ied to the body posture inclination angle correcting 
perturbation model 203, and a correcting perturbation model body 
posture inclination angle 9c is determined by the body posture 
inclination angle correcting perturbation model 203. 
25 :0959] 

The simplified model body posture inclination angle 
corr€?cting moment Mrs, which is the other output of the 
distributor 220, is supplied to the simplified model 200. This 
corresponds to supplying the simplified model body posture 
30 inclination angle correcting moment Mr to the simplified model 
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200 j.n Fag. 76 in the aforementioned sixth embodiment. 
0960] 

".'he distributor 221 receives a value obtained by integrating 
the A/alue, which is obtained by multiplying a full-model floor 
5 react:ion force moment horizontal component error Merr by a gain 
Km, by an integrator 217a and reversing the sign thereof. 

: 0 9 6 1 ] 

An. input to the distributor 221 is divided into a simplified 
model horizontal body position correcting moment Mps to be 

10 supplied to the simplified model 200 and an error correcting 
moment Me to be supplied to a horizontal body position correcting 
perturbation model 202, as in the case of the distributor 220. 
To be more specific, an error correcting moment Me is determined 
on the basis of an output of the integrator 217a. For instance, 

15 the 6?rroi" correcting moment Me is determined by subjecting an 
output of the integrator 217a (an input of the distributor 220) 
to the processing of signals having a dead-zone characteristic, 
a saturation characteristic or a frequency characteristic. The 
resu:_t obtained by subtracting the error correcting moment Me 

20 from an output of rhe integrator 217a is determined as the 
simp:.ified model body posture inclination angle correcting 
moment. Mrs. To explain more specifically, in the present 
embodiment, the distributor 221 outputs a low-frequency 
component (DC component) , which is obtained by passing an input 

25 (an output of the integrator 217a) through a low-pass filter, 
as a simplified model horizontal body position correcting moment 
Mps, and also outputs the component obtained by subtracting Mps 
from the input (the output of the integrator 217a) as the error 
correcting moment Me. In this case, the dead-zone 

30 characteristic is imparted to the simplified model horizontal 
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body oosition correct:ing moment Mps, which is the 1 ow- frequency 
component (DC component) , such that, in a state wherein an output 
of the low-pass filter lies within a predetermined range 
centering around a certain predetermined value, the Mps is 
maintained at that predetermined value (e.g., zero). 
[0962 ] 

The horizontal body position correcting perturbation model 
moment Mp is determined by adding a horizontal body position 
correcting model stabilization moment Mpf to the error 
correcting moment Me, which is an output of the distributor 221, 
by an Mp calculator 217b. Then, the horizontal body position 
correcting perturbation model moment Mp is supplied to the 
hori2ontal body position correcting perturbation model 202, and 
the correcting perturbation model horizontal body position Xc 
is determined by the horizontal body position correcting 
perturbation model 202. 
I 0963] 

The simplified model horizontal body position correcting 
moment Mps, which is the other output of the distributor 221, 
is supplied to the simplified model 200. This is equivalent to 
supplying the simplified model horizontal body position 
corr€iCting moment Mp to the simplified model 200 in Fig. 76 of 
the aforementioned fifth embodiment. 
.:0964] 

An antiphase arm swing angle correcting perturbation model 
moment determiner 240 is identical to the antiphase arm swing 
angle? correcting perturbation model moment determiner shown in 
Fig. 80 used in the fifth embodiment. However, the antiphase 
arm swing angle correcting perturbation model moment Ma, which 
is an output shown in Fig. 80, is supplied to the distributor 
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241 r£ither than being directly supplied to the antiphase arm swing 
angle corirecting perturbation model . In the present embodiment, 
therefore, the designation of the antiphase arm swing angle 
correcting perturbation model moment Ma is modified to the 
5 antiphase arm swing angle correcting model moment Ma. 
[0965] 

The distributor 241 receives, as an input, the antiphase arm 
swing angle correcting model moment Ma determined by the 
antiphase arm swing angle correcting perturbation model moment 
10 determiner 240. 
[0966] 

As in the case of the distributor 220, an input to the 
distributor 241 is divided into a s impl i f led model antiphase arm 
swing angJ.e correcting moment Mas to be supplied to the simplified 

15 model 200 and an antiphase arm swing angle correcting 
perturbation model input Mai to be supplied to the antiphase arm 
swing angle correcting perturbation model 231. 

At this time, the antiphase arm swing angle correcting 
perturbation model input Mai and the simplified model antiphase 

20 arm swing angle correcting moment Mas are determined (output) 
such that the sum of the antiphase arm swing angle correcting 
perturbation model input Mai and the simplified model antiphase 
arm swing angle correcting moment Mas agrees with the antiphase 
arm swing angle correcting model moment Ma. 

25 [0967] 

To be more specific, antiphase arm swing angle correcting 
perturbation model input Mai is determined on the basis of the 
antiphase arm swing angle correcting model moment Ma. For 
example, the antiphase arm swing angle correcting model moment 
30 Ma is subjected to the processing of signals having a dead-zone 
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characteristic, a saturation characteristic or a frequency 
characteristic so as to determine antiphase arm swing angle 
correcting perturbation model input Mai. The result obtained 
by subtracting the antiphase arm swing angle correcting 
perturbation model input Mai from the antiphase arm swing angle 
correcting model moment Ma is determined as the simplified model 
antip'hase arm swing angle correcting moment Mas . To explain more 
specifically, in the present embodiment, the distributor 241 
outputs a low-frequency component (DC component), which is 
obtained by passing an input (the antiphase arm swing angle 
correcting model moment Ma) through a low-pass filter, as a 
simplified model antiphase arm swing angle correcting moment Mas, 
and also outputs the component obtained by subtracting the Mas 
from the input (antiphase arm swing angle correcting model moment 
Ma) as the antiphase arm swing angle correcting perturbation 
mode.1 input Mai. In this case, the dead-zone characteristic is 
imparted to the simplified model antiphase arm swing angle 
correcting moment Mas, which is the low- frequency component (DC 
component), such that, in a state wherein an output of the 
low-pass filter lies within a predetermined range centering 
around a certain predetermined value, the Mas is maintained at 
that predetermined value (e.g., zero) . 
[0968] 

The antiphase arm swing angle correcting perturbation model 
input Mai, which is an output of the distributor 241, is supplied 

to the antiphase arm swing angle correcting perturbation model 
231, and a correcting perturbation model antiphase arm swing 
angle Oca is determined by the antiphase arm swing angle 
correcting perturbation model 231. 
[0969] 
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The simplified model antiphase arm swing angle correcting 
moment Mas, which is the other output of the distributor 241, 
is supplied to the simplified model 200, This corresponds to 
supplying the simplified model antiphase arm swing angle 
correcting moment Ma to the simplified model 200 in Fig. 76 in 
the aforementioned sixth embodiment. 
[0970] 

P.s in the aforesaid sixth embodiment, the simplified model 
200 generates the instantaneous value of a gait such that no floor 
reaction force moment horizontal component is generated about 
a desired ZMP (setting the model manipulation floor reaction 
force moment to zero) in the processing for calculating 
(determining) the instantaneous value of a s impl i f led mode 1 gait, 
adds a per turbat i onal motion of a body inclination mode that 
generates a simplified model body posture inclination angle 
correcting moment Mrs (last time value), adds a perturbational 
motion of a body trans lational mode that generates a simplified 
model horizontal body position correcting moment Mps (last time 
value ) , and further adds a perturbational motion of an antiphase 
arm spring mode that generates the simplified model antiphase arm 
swing angle correcting moment Mas, thereby correcting the 
instantaneous value of the gait. 
I 0971] 

In the present embodiment, in S800 of Fig. 32, which is a 
part of the processing of S3528 of Fig. 65, the state amount of 
a simplified model at the end of the last time gait is used as 
the terminal state of the last time gait. Therefore, if there 
is a moment when Mrs, Mps and Mas output to a simplified model 
from the distributors 220, 221, and 241 take values other than 
zero, then the behavior of the simplified model deviates from 
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its crigmal behavior, so that gait parameters are corrected 
accordingly as necessary in S3528. As the aforesaid dead-zone 
area is set to be wider, then the absolute values of Mrs, Mps, 
and Mas become smaller, so that the absolute values of the 
5 correction amounts of the gait parameters become also smaller. 
[0972] 

Ihe rest of the construction and processing are the same as 
those of the fifth embodiment. More detailedly, the processing 
of ca Lculators 204 and 205, a calculator for calculating a desired 

10 horizontal body position, a Merr calculator 216, a body posture 
inclination angle correcting perturbation model control law 207, 
a hor Lzontal body position correcting perturbation model control 
law 2 36, a Min calculator 209, a Fin calculator 2 1 0 , a restriction 
proce'ssrng unit 211, an Mpf calculator 215, and an antiphase arm 

15 swine angle correcting perturbation model moment determiner 240 
is the same as that of the aforementioned fifth embodiment. 
I 0 973] 

]:n the present embodiment, it is not necessary to carry out 
the processing for correcting the state amount of the simplified 

20 mode] 200 on the basis of the state amounts of the perturbation 
modeJ.s 202, 203, and 231 at the end of a current time gait or 
the like as explained in the aforesaid fourth embodiment. This 
is because the simplified model body posture inclination angle 
correcting moment Mrs, the simplified model horizontal body 

25 position correcting moment Mps, and the simplified model 
antiphase arm swing angle correcting moment Mas are additionally 
supp]-ied from the distributors 220, 221, and 241. 
.:0974] 

::n the present embodiment described above is capable of 
30 providing the operations and advantages similar to those of the 
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aforesaia fifth embodiment or the sixth embodiment. 
I 0 975] 

Jn the present embodiment, one of the two outputs of each 
of the distributors 220, 221, and 241 may be set to zero, while 
5 the other is matched with an input. 

I 0 9761 

In this case, if, for example, the simplified model body 
posture inclination angle correcting moment Mrs, which is an 
output of the distributor 220, is set to zero, the simplified 

10 model horizontal body position correcting moment Mps, which is 
an output of the distributor 221, is set to zero, and the 
simplified model antiphase arm swing angle correcting moment Mas, 
which is an output of the distributor 241, is set to zero, then 
the same operations and advantages of the fifth embodiment will 

15 be provided (actually, the same construction as that of the fifth 
embodiment will be provided) . 
[0977] 

Alternatively, the value obtained by adding the horizontal 
body position correcting model stabilization moment Mpf to the 

20 error correcting moment Me may be supplied to a third distributor, 
not shown, and one of the outputs thereof may be supplied to the 
horizontal body position correcting perturbation model 202, 
while the other output may be added to the simplified model 
horizontal body position correcting moment Mps . In this case, 

25 the simplified model horizontal body position correcting moment 
Mps, which is an output of the distributor 221, may be set to 
zero. In other words, the distributor 221 may be omitted, and 
the value obtained by multiplying the full-model floor reaction 
force moment error Merr by the gain Km may be integrated. The 

30 sign of the integrated value may be reversed and added to the 
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horizontal body position correcting model stabilization moinent 
Mpf, and the resulting value may be supplied to the third 
distributor . 
[0978] 

In the second to the seventh embodiments explained above, 
the compensating total floor reaction force moment horizontal 
component Mdmdxy may be determined on the basis of the state 
amounts of other postures of the robot 1, such as total 
center~of -gravity horizontal position/ velocity , in place of the 
body posture angle /angular velocity. 

[0979] 

A seventh embodiment in accordance with the present 
invention will now be explained with reference to Fig. 82 to Fig. 
89 . 

[0980] 

The functional block diagram of a control unit 26 in the 
present embodiment is shown in Fig. 82. In comparison with the 
thirc embodiment, the present embodiment has added thereto a 
slippage determiner 114 . A slippage determination result output 
from the slippage determiner 114 is supplied to a gait generator 
100. The gait generator 100 narrows a floor reaction force 
horizontal component permissible range and a floor reaction 
force moment vertical component permissible range that are 
determined on the basis of gait parameters if a slippage 
deteimination result indicates the presence of a slippage. If 
a slippage determination result indicates the absence of a 
slippage, then the gait generator 100 restores the floor reaction 
force horizontal component permissible range and the floor 
reaction force moment vertical component permissible range that 
are determined on the basis of gait parameters. The rest of the 
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construction and processing are the same as those of the aforesaid 
thi rd embodiment . 
[0981 ] 

The slippage determiner 114 will be explained in detail in 
conjunction with Fig. 85, which is a flowchart illustrating the 
processing thereof. First, a spin determining subroutine is 
implemented in S5210. The spin determining subroutine proceeds 
to S5310 of Fig. 86, which is the flowchart thereof, to determine 
a ground angular velocity vertical component cosupz of a 
supporting leg foot on the basis of an actual body posture angular 
velocity and a joint angle command (detection value) . Then, the 
processing proceeds to S5312 wherein a changing rate 
dMsuF)act z /dt of a supporting leg floor reaction force moment 
vertical component, which is the temporal changing rate of an 
actual floor reaction force moment vertical component acting on 
the supporting leg is determined on the basis of a detection value 
(actual floor reaction force) of a 6-axis force sensor of the 
foot. Next, the processing proceeds to S5314 wherein it is 
dete^rmined whether the absolute value of the ground angular 
veloc:ity vertical component cosupz of the supporting leg foot 
exceeds a predetermined value coe . If the absolute value exceeds 
it, then the processing proceeds to S5316 wherein the changing 
rate dMsupactz/dt of the supporting leg floor reaction force 
moment vertical component is divided by the aforesaid ground 
angular velocity vertical component cosupz of the supporting leg 
foot, and the sign of the obtained value is reversed to determine 
an apparent torsion spring constant Ksupt of the supporting leg. 
Then, the processing proceeds to S5318 wherein it is determined 
whether Ksupt is smaller than a predetermined value Ksuptmin, 
and if it is smaller, then the processing proceeds to S5320 
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wherexn i:he presence of a spin is determined as a spin 
determination result, or if it is not, then the processing 
proceeds to S5322 wherein the absence of a spin is determined 
as the spin determination result. Furthermore, if it is 

.5 determined in S5314 that the absolute value of the ground angular 
velocity vertical component cosupz of the supporting leg foot does 
not exceed the aforesaid predetermined value coe, then the 
processing proceeds to S5324 wherein the absence of a spin is 
determined as a spin determination result. 

10 [0982] 

After finishing the processing of S5210 as described above, 
the processing proceeds to S5212 wherein a translational 
slipF>age determining subroutine is implemented. 

10 9 8 3] 

15 The translational slippage determining subroutine proceeds 

to S5410 of Fig. 87, which is the flowchart thereof, to determine 
a grcund translational velocity horizontal component Vsupxy of 
a supporting leg foot on the basis of an actual body posture 
angular velocity, an acceleration detection value, and a joint 

20 angle command (detection value) . Then, the processing proceeds 
to S^.'4 12 wherein a changing rate dFsupactxy /dt of a supporting 
leg ei.oor reaction force horizontal component, which is the 
temporal changing rate of an actual floor reaction force 
horizontal component acting on the supporting leg is determined 

25 on the basis of a detection value (actual floor reaction force) 
of ttie 6-axis force sensor of the foot. Next, the processing 
proceeds to S5414 wherein it is determined whether the absolute 
value of the ground translational velocity horizontal component 
Vsupxy of the supporting leg foot exceeds a predetermined value 

30 Ve. If the absolute value exceeds it, then the processing 
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proceeds to S5416 wherein the changing rate dFsupactxy /dt of the 
supporting leg floor reaction force horizontal component is 
divided by the aforesaid ground tr anslat ional velocity 
horizontal component Vsupxy of the supporting leg foot, and the 
5 sign of the obtained value is reversed to determine an apparent 
shear spring constant Ksups ( -dFsupactxy /dt ) /Vsupxy) of the 
supporting leg. Then, t.he processing proceeds to S5418 wherein 
it is determined whether Ksups is smaller than a predetermined 
value Ksupsmin, and if it is smaller, then the processing proceeds 

10 to S5420 wherein the presence of a translational slippage is 
determined as a translational slippage determination result, or 
if it is not, then the processing proceeds to S5422 wherein the 
absence of a translational slippage is determined as the 
translational slippage determination result. Furthermore, if 

15 it is determined in S5414 that the absolute value of the ground 
translational velocity horizontal component Vsupxy of the 
supporting leg foot does not exceed the aforesaid predetermined 
value Ve, then the processing proceeds to S5424 wherein the 
abser.ce of a translational slippage is determined as a 

20 trans-lati onal slippage determination result. 
I 0984 ] 

After finishing the processing of S5212 as described above, 
the processing proceeds to S5214 wherein a slippage vibration 
determining subroutine is implemented. 

25 The slippage vibration determining subroutine proceeds to 

S5510 of Fig. 88, which is the flowchart thereof, and passes the 
detection value (a translational force horizontal component 
and/or a moment vertical component) of the 6-axis force sensor 
of ttie foot through a band-pass filter to extract a slippage 

30 vibration component. Instead of using the detection value of 
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the 6-axis force sensor of the foot, the foot may be provided 
with a yaw rate sensor, an acceleration sensor or the like to 
use the detection values thereof. Then, the processing proceeds 
to S5 512 wherein it is determined whether the absolute value of 
5 the size of the detected slippage vibration component exceeds 
a certain predetermined value Ampe . If the absolute value 
exceeds ttie predetermined value, then the processing proceeds 
to S5514 wherein a slippage vibration determination result that 
indicates the presence of a slippage vibration is given. If the 
10 absolute value does not exceed it, then the processing proceeds 
to 35516 wherein a slippage vibration determination result that 
indicates the absence of a slippage vibration is given. 
[0985] 

After finishing the processing of S5214 as described above, 
15 the processing proceeds S5216, and if a spin determination result 
indicates the presence of a spin, or if a translat ional slippage 
determination result indicates the presence of a translational 
slippage, or if a slippage vibration determination result 
indicates the presence of a slippage vibration, then the 
20 processing proceeds to S5218 wherein a slippage determination 
result, which is an overall determination result, is given to 
indicate the presence of a slippage. If not, then the processing 
proceeds to S5220 wherein the slippage determination result, 
which is the overall determination result, is given to indicate 
25 the absence of a slippage. This completes the processing of the 
slippage determiner 114. 
[0986] 

B'ig. 83 shows the flowchart of the main routine processing 
of the gait generator 100 in the present embodiment. 
30 [0987] 
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In this Fig. 83, from S2310 to S2332, the same processing 
as that from S2010 to S2032 of the flowchart (Fig. 61) of the 
third embodiment is carried out , 

[0988] 

Subsequently, the p^rocessing proceeds to S2334 wherein a 
subroutine for determining a corrected gait instantaneous value 
is implemented. In the present embodiment, a corrected gait 
instantaneous value determining subroutine determines a 
corrected gait instantaneous value such that a desired ZMP and 

10 an antiphase arm swing restoring angular acceleration pattern 
are corrected so as to approximate them to an original gait, and 
also a model manipulation floor reaction force moment (a 
horizontal component and a vertical component) is additionally 
generated about a corrected desired ZMP. The floor reaction force 

15 permissible range is changed according to a slippage 
determination result. This aspect is different from the second 
embodiment . 
[0989] 

Fig. 84 shows the flowchart of the corrected gait 
20 instantaneous value determining subroutine. In the corrected 
gait :_ns t£intaneous value determining subroutine, the processing 
from 35100 to S5114 is first carried out in the same manner as 
that from S2100 to S2112 of Fig. 62, which is the corrected gait 
instantaneous value determining subroutine of the third 
25 embodiment. Then, the processing proceeds to S5116 wherein it 
determines whether the slippage determination result by the 
aforesaid slippage determiner 114 indicates the presence of a 
slippage, and if the slippage determination result indicates the 
presence of a slippage, then the processing proceeds to S5118 
30 wherein a permissible range reducing rate att is gradually 
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approximated to zero (decreased substantially continuously) . 
Incidentally, the permissible range reducing rate att is to take 
a value from 0 to 1 . If it is determined in S5116 that the slippage 
determination result indicates no slippage, then the processing 
proceeds 10 S5120 wherein the permissible range reducing rate 
att is gradually approximated to 1 (increased substantially 
continuously) . Subsequently, the processing proceeds to S5122 
wherein Fxmin, Fxmax, Mzmin and Mzmax, which are the upper limit 
values and the lower limit values of the permissible ranges of 
the floor reaction force horizontal component and the floor 
reaction force moment vertical component, respectively, 
determined in S5110 and S5112, are multiplied by the permissible 
range reducing rate att so as to narrow the floor reaction force 
horizontal component permissible range and the floor reaction 
force moment vertical c:omponent permissible range. It is a 
matter of course that, if the reducing rate is 1, the original 
floor reaction force permissible ranges will not be narrowed- 
[0990] 

Fig. 89 shows an example illustrating how the permissible 
range reducing rate att, the final floor reaction force 
permissible ranges (specifically, a floor reaction force 
horizontal component permissible range and a floor reaction 
force moment vertical component permissible range) change 
according to slippage determination results. 

If a slippage occurs, the robot may fall unless a gripping 
state is promptly restored. Hence, if it is determined that a 
slippage has occurr^id, then the final floor reaction force 
permissible range should be quickly narrowed. However, unduly 
sudden narrowing would lead to an excessive change in 
acceleration of a gait with a resultant impact; therefore, a 
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proper value that does not lead to a sudden change should be set. 
[ D 9 9 1 ] 

If it is determined that there is no longer a slippage, then 
the permissible range should be quickly set back to the original 
5 permissible range (the floor reaction force permissible range 
determined in S5110 and S5112 ) . If the permissible range remains 
narrower, then a corrected gait will significantly deviate from 
an original gait. However, unduly sudden restoration would lead 
to an excessive change in acceleration of the motion of the gait, 
10 resul:ing in a slippage again due to an impact; therefore, a 
prope:: value that does not cause an unduly sudden restoration 
should be set . 
[0 992 1 

Subsequently, the processing proceeds to S5124 wherein a 
15 model manipulation floor reaction force moment horizontal 
component, a desired floor reaction force moment for compliance 
control (a horizontal component and a vertical component) , a 
horizontal body acceleration, a body posture inclination angular 
accele^rati.on, and an antiphase arm swing angular acceleration 
20 are de^terniined such that the conditions of the floor reaction 
force moment horizontal component permissible range, the floor 
reaction force moment veartical component permissible range, and 
the floor reaction force horizontal component permissible range 
c'lre satisfied, as in S2114. 
25 Subsequently, the processing proceeds from 85126 to S5128 

to cai^ry out the same processing as that of S2116 to S2118. 
[ 0993] 

Ttie corrected gait instantaneous value determining 
subroutine is implemented as described above. Then, the 
M) processing proceeds to S2336 wherein current time t is 
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incremented by At, and returns to S2314 again to continue 
generating gaits . 
[ 0 994 1 

Tne^ al:)Ove is the processing of the gait generator 100 in the 
5 present embodiment, 

[ 3 9 95 ] 

A3 described above, in the eighth embodiment, the floor 
reaction force horizontal component permissible range and the 
floor reaction force moment vertical component permissible range 

10 are changed according to a slippage determination result. 
Alternatively, however, only one of the floor reaction force 
horizontal component permissible range and the floor reaction 
force moment vertical component permissible range may be 
changed . 

15 [0996] 

Generally, if the foot slips parallel on a floor surface (if 
it slLp)s rn a shearing direction), then the gripping force in 
a spin direction (yaw direction) accordingly decreases. 
Conversely, if the foot slips in the spin direction (yaw 

20 direction), then the foot easily slips parallel on the floor 
surfai:e. Hence, narrowing (setting to zero) both the floor 
reaction force horizontal component permissible range and the 
floor reaction force moment vertical component permissible range 
when either slippage is detected will achieve more effective 

25 recovery from the slippage. 
[0997] 

Farther, as the gait generator in the eighth embodiment, the 
one in any of the first, second and the fourth to the seventh 
embodiments may be used in place of the one in the third embodiment 
30 Moreo\>^er, as previously described, in the third to the seventh 
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embocl Lment s , the floor reaction force horizontal component 
permi.ssibLe range and the floor reaction force moment vertical 
component permissible r^inge come in two types, namely, one for 
simplified model gaits and the other for gait correction. All 
these permissible ranges may be changed. Alternatively, at 
least the permissible range of either one for gait correction 
should be changed according to a slippage determination result. 
[^■)998] 

In the seventh embodiment, as the method for determining 
slippages, any one of the following may be used in addition to 
the methods described in the embodiments. Alternatively, these 
results may be comprehensively determined (using logical 
operatiions, including logical sums and products). 
1) The: angular velocity of the foot with respect to a floor is 
determined using an angular velocity detector or the like, and 
xf the absolute value of this value exceeds a predetermined value, 
then j.t is determined that a slippage has occurred. 
2 ) 1 f the absolute value of a floor reaction force moment of either 
leg exceeds a predetermined value, then it is determined that 
£i slip)page has occurred. 

3) If the eibsolute value of a total floor reaction force moment 
(the moment of the resulting force of the floor reaction forces 
of both Legs) exceeds a predetermined value, then it is determined 
that a slippage has occurred. 

4) In a double stance period, i f the value obtained by multiplying 
the ratio of the changing rate of a total floor reaction force 
moment to a body posture angular velocity error by (-1) is smaller 
than a predetermined value (the torsional rigidity when both legs 
are in contact with the ground), then it is determined that a 
slippage has occurred. 
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5) If r,he absolute values of detections values (estimated values) 
of a non-contact type ground velocity or angular velocity 
detector using a visual sensor, a spatial filter or the like, 
or of a contact-type ground velocity or angular velocity detector 
5 exceed a predetermined value, then it is determined that a 
slippage has occurred. 
[3999] 

In the aforesaid third to eighth embodiments, the 
compensating total floor reaction force moment horizontal 

10 component and the compensating total floor reaction force moment 
vertical component have been determined; alternatively, however, 
the compensating total floor reaction force moment horizontal 
component may be set to zero. In this case, however, the body 
posture inclxnation restoring effect and/or the body yaw angle 

15 (angu;:.ar velocity) restoring effect provided by correcting a 
gait by using a full model is not available. 
[ 1 0 0 0 

In the aforementioned fourth to seventh embodiments, the 
generation of gaits by the simplified model 200 (the generation 

20 of simplified model gaits) may be performed using the gait 
generators according to the first embodiment and the second 
embodiment:. in the Japanese Unexamined Patent Application 
Public:ation No. 5-337849 previously proposed by the present 
applicant . The correction amount by a full model can be reduced, 

25 making it possible to prevent a corrected gait from significantly 
deviat.ing from a simplified model gait. 
[ ]. 0 0 1 ] 

In the aforesaid second embodiment, if the compensating 
total floor reaction force moment horizontal component Mdmdxy 
.^0 exceeds a floor reaction force moment permissible range 
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horizDRtal component (in the third embodiment and after, if the 
sum cf the compensating total floo2: reaction force moment 
horizontal component Mdmdxy and a model manipulation floor 
reaction force moment horizontal component exceeds a floor 
reaction jforce moment permissible range), then a desired floor 
reaction force moment horizontal component for compliance 
contr(3l takes an upper limit value or a lower limit value of the 
floor reaction force moment horizontal component permissible 
range. Alternatively, however, the desired floor reaction force 
moment horizontal component for compliance control may be 
increased or decreased as the compensating total floor reaction 
force moment horizontal component Mdmdxy (in the third 
embodiLiTient and after, the sum of the compensating total floor 
react:.on force moment horizontal component Mdmdxy and the model 
manipulation floor reaction force moment horizontal component) 
lncre^ises or decreases even if the compensating total floor 
reaction force moment horizontal component Mdmdxy (in the third 
embodiment and after, the sum of the compensating total floor 
reaction force moment horizontal component Mdmdxy and the model 
manipulation floor reaction force moment horizontal component) 
exceeds the floor reaction force moment horizontal component 
permissible range. This is because, as the desired floor 
reaction force moment horizontal component for compliance 
control approximates to a floor reaction force moment horizontal 
component permissible range, an actual floor reaction force 
moment horizontal component controlled by the compliance control 
tends to be smaller than the desired value, and therefore, even 
if the desired floor reaction force moment horizontal component 
for compliance control slightly exceeds a permissible range, it 
is very likely that this does not immediately cause a problem, 
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such cis a deteriorated intrinsic ground contacting property of 
the f'DOt 22 or floating of the sole of the foot 22, 
[ 10 02 ] 

For the same reason, the floor reaction force moment 
5 horizontal component permissible range may be set to exceed a 
permissible range obtained by converting the range, in which ZMP 
can exist and which his represented by a supporting polygon (in 
a strict expression, the permissible range in which actual floor 
reaction force points of action exist), into moment horizontal 
10 components. 

[ 1003 1 

Undue dependence on the floor reaction force moment 
horizontal component produced by compliance control causes a 
problem, such as a deteriorated intrinsic ground contacting 

15 property of the foot 22 or floating of the sole of the foot 22, 
as described above. Hence, the floor reaction force moment 
norizontal component permissible range may be said to be the 
permissible range of actual floor reaction force moment 
horizontal components that posture control expects of the 

20 compliance control. 
[10 0 4] 

Tne floor reaction force moment horizontal component 
permissible range may alternatively be determined on the basis 
of also detected actual floor reaction forces rather than only 
25 on the basis of gait parameters. Further, it may be also 
determined on the basis of detection values of ground contact 
regions of the foot 22, such as edge position detection values 
on stairs, 
[10 0 5 1 

30 Meanwhile, undue dependence on the floor reaction force 
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momeri :. vertical component produced by compliance control causes 
a problem, such as spinning. Hence, the floor reaction force 
momen:. vertical component permissible range may be said to be 
the permissible range of actual floor reaction force moment 
5 vertical components that posture control expects of the 
compliance control. 
[ 1,0 0 6 ] 

Tie processing of the main flowchart may be changed so as 
to implement the correction of a current time gait parameter (the 
10 correction of a desired ZMP) in S3028 of Fig. 55 of the second 
embodimenr for each control cycle. 
[ 10 07 ] 

If a corrected gait (desired gait) considerably deviates 
(diverges) from an original gait, it will have excessively 

15 deviated (excessively diverged) by the time the gait parameter 
correction of the next gait is implemented, making it difficult 
to generate a desired gait that continuously remains stable for 
long periods simply by correcting gait parameters of the next 
gait . This problem can be solved to a great extent by correcting 

20 the carrent time gait parameter (by correcting a desired ZMP) 
for each control cycle. 
[10 0 8] 

Furthermore, depending on deviation from an original gait, 
a foot landing position or landing time of the current time gait 
25 may be changed for each control cycle - 

[ 1 (3 0 9 ] 

Specifically, the processing flow is changed so as to carry 
out the processing from S3020 to S3030 for each control cycle, 
and then in S3020, at least one of the next time's gait supporting 
30 leg coordinate system (the next time's gait supporting leg 
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i:oord.Lna te system corresponding to the next foot landing 
position/posture), the next but one time's gait supporting leg 
coordinate system (the next but one time's gait supporting leg 
coordinates system corresponding to the next but one time foot 
landing position/posture), the current time gait cycle (the 
current time gait cycle corresponding to the next foot landing 
time), and the next time gait cycle (the next time gait cycle 
corresponding to the cycle of normal gait) is changed as necessary 
to reduce the correction of the current time gait parameter in 
S3028 (the correction of the desired ZMP in particular) (that is, 
to maintain a high stability allowance of the current time gait) . 
[ L 0 1 0 1 

Furthermore^ different gait parameters from those mentioned 
above may be changed. 
[ LOll ] 

Tn€? de^viation of a corrected gait from an original gait can 
be estimated, using a dynamic model, primarily from a simplified 
model body posture inclination angle correcting moment Mr, a 
simplified model horizontal body position correcting moment Mp, 
and a simplified model antiphase arm swing angle correcting 
momeni Ma. Hence, based on Mr, Mp and Ma, model behavior 
devia -ions may be estimated and gait parameters may be corrected 
on the basis of the estimated behavior deviations. 
Alternatively, the relationship between Mr, Mp and Ma and the 
proper values of gait parameter correction amounts may be 
determined beforehand and mapped so as to determine the 
correction amounts of gait parameters according to the map on 
the br:isis of Mr, Mp and Ma. 

[1012 1 

The processing flow may be changed also for other embodiments 
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(the ihird to the seventh embodiments) in the same manner as 
described above. 
[1013 1 

In addition to the aforementioned conditions, other 
5 kinematic conditions and dynamic conditions , e.g., whether joint 
angles exceed a permissible range, whether legs or the like are 
interfering, or whether a joint angular velocity or torque is 
too high, may be added to the restoring conditions . 
[1014] 

10 Accordingly, the following may be added as one of the 

restoring conditions: if the processing of a main flowchart has 
been changed so as to implement the correction of a current time 
gait parameters (the correction of a desired ZMP or a landing 
position, time or the like) for each control cycle as described 

15 above^ then the value of the gait parameter, which is changed 
as necessary to maintain a high stability allowance of a current 
gait, is set to a proper value (to satisfy a certain restrictive 
condi t i on } . 
[ L 0 1 5 ] 

20 The landing position and the landing time determined (read 

in) at: a gait switching point are determined in response to an 
instruction from a highe^r control unit (mainly an instruction 
from a walking plan determiner or from an operator. This is 
referred to as an original request) . Thus, the landing position 

25 and the landing time of a corrected gait should be returned to 
the landing position and the landing time determined (read in) 
at the gait switching point as much as possible . For this reason, 
the landing position and the landing time determined (read in) 
cit the ga.it switching point may be stor-ed, and the landing 

30 posit:.on and the landing time of a corrected gait may be matched 
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to or approximated to the stored landing position and landing 
time .as much as possible. This may be added to the restoring 
conditions. Actually, however, the landing position and the 
landing time of a corrected gait are arranged so as to gradually 
5 returi, as much as possible, to the landing position and the 
landiig time determined (read in) at a gait switching point by 
the aforementioned restc^ring conditions 4, 5 and 6; therefore, 
it is not essential to add the above additional condition. 
[1016] 

10 Another condition, in which an original request is changed 

in response to a change of a situation and the gait parameter 
changed as necessary to maintain a high stability allowance of 
a gai~ as described above is matched with or approximated to, 
as muc:h as possible, a gait parameter that satisfies the changed 

15 request, may be added to the res tor ing conditions . In this case, 
the aforementioned aforementioned restoring conditions 4, 5 and 
6 should be deleted. 
[1017] 

As the method for determining a model horizontal body 
20 position stabilization floor reaction force moment and a model 
body posture inclination angle stabilization floor reaction 
force moment that satisfy the various restoring conditions 
described above, a linear programming (e.g., simplex method) or 
a retrieval method for determining optimum values under 
25 restrictive conditions may be used. Alternatively, a fuzzy 
inference may be used. 
[1018] 

When changing a landing position, a situation wherein 
obstacles in a wal]<:ing environment or the lilce have to be tal<en 
30 into account is conceivable. To make it possible to cope with 
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ouch a .situation, a corrected gait should be determined by also 
addincj th€^ processing that belongs to the field of artificial 
Intel.. igence , such as recognition of environments and 
determination of actions. 
5 [1019; 

The same applies to the method for determining a model 
antiphase arm swing angle stabilization floor reaction force 
moment . 

[ :_02 0 j 

10 The block diagrams before and after the limiting means (the 

restrj,ction processing unit) in the aforementioned fourth to 
sevent,h embodiments may be subjected to equivalent conversion 

or approximate conversion as shown in, for example, 
PCT/ JP02/13593 by the present applicant. 
15 [ :. 0 2 1 ] 

In this case, the value obtained by subtracting the value 
obtained by passing the value, which has been obtained by dividing 
a horizontal body position correcting model stabilization moment 
Mpf by h, through a low-pass filter from a corrected desired floor 

.20 reacti on force horizontal component (a full-model floor reaction 
force horizontal component Ffull) corresponds to a biased 
estimated value destm in the above PCT application. Hence, for 
example, the integration of the gain Kc in the aforementioned 
fourth to sixth embodiments may be replaced into a positive 

25 feedback system having the first-order lag of a time constant 
1/Kc as a feedback element to perform the approximate conversion 
as shewn in Fig. 78. In this example, the Mpf calculator 215 
in th€) fourth to the sixth embodiments is subjected to the 
approximate conversion as illustrated in the figure. 

30 [1022] 
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Thej. antiphase arm swing angle correcting perturbation model 
momeni: determiner and the antiphase arm swing angle correcting 
perturbation model moment determiner may be also determined by 
implementing the equivalent conversion or approximate 
conversion in the same manner. 

[10 2 3: 

In the aforementioned third embodiment, for the aforesaid 
antiphase arm swing angle correcting perturbation model moment, 
the processing of the functional block diagram shown in Fig. 81 
may be carried out in place of the functional block diagram shown 
in Fig. 19. This will be explained below, taking this as an 
eighth embodiment. In Fig. 79, the behavior of an antiphase arm 
swing angle correcting model has been decided by determining 
whethe^r a floor reaction force moment vertical component, 
including the moment vertical component generated by a motion 
2:estoied by an antiphase arm swing angle correcting model, 
65xceeds a floor reaction force moment vertical component 
permissible range. In the processing of the functional block 
dic'agram shown in Fig. 81, the moment vertical component generated 
by the motion restored by an antiphase arm swing angle correcting 
model is ignored in determining whether the floor reaction force 
moment permissible range is exceeded. 

[] 024] 

The processing of the functional block diagram shown in Fig. 
81 will be explained in detail. The sum of a full-model floor 
reaction force moment vertical component Mfullz, a floor 
reaction force moment vertical component perturbation amount Mpz 
attributable to the correction of a horizontal body position, 
and a compensating total floor reaction force moment vertical 
component Mdmdz is defined as a corrected desired floor reaction 
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force rnomc'rit vertical component without restriction Minz, and 
a restriction is added thereto in the same manner as that shown 
in Fig. 79 to determine a corrected desired floor reaction force 
moment: vertical component with restriction Mltdz . The corrected 
desired floor reaction force moment vertical component with 
restriction Mltdz is output as a desired floor reaction force 
moment, vertical component for compliance control. Furthermore, 
the value obtained by subtracting the corrected desired floor 
reaction force moment vertical component without restriction 
Minz from the corrected desired floor reaction force moment 
vertical component with restriction Mltdz, i.e., a portion Maa, 
which is the portion of the corrected desired floor reaction force 
moment vertical component without restriction Minz that exceeds 
the floor reaction force moment vertical component permissible 
range, is determined. Then, based on the last time value of a 
correcting perturbation model antiphase arm swing angle 0ca, a 
required value Mafdmd of antiphase arm swing angle correcting 
model stabilization moment is determined according to an 
antiphase arm swing angle correcting perturbation model control 
law us ing FD control or the like, and the value (moment) obtained 
by subtracting the determined value from Maa is supplied to an 
antiphase arm swing angle correcting perturbation model to 
obtain the correcting perturbation model antiphase arm swing 
angle 9ca . 
[1025] 

The transfer functions from Maa to the correcting 
perturbation model antiphase arm swing angle 0ca provide the 
transfer functions of a low-pass filter. 

[1026] 

More specifically, in other words, a floor reaction force 
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inomerr: vertical component (a floor reaction force moment 
vertical component without restriction) generated when the floor 
reactron force moment vcertical component by the antiphase arm 
swing angle correcting model is not canceled (excess preventing 
5 operation is not performed) is passed through a restricting means 
(saturating means) that restricts it so as not to exceed the floor 
react:_on force moment vertical component permissible range, 
theret^y obtaining a desired floor reaction force moment vertical 
component for compliance control (a corrected desired floor 

10 reaction force moment vertical component with restriction Mltdz) . 
In addition, the value obtained by passing the floor reaction 
force mom€int vertical component without restriction through a 
dead-:'.one means for determining the portion exceeding the floor 
react]. on force moment ve^rtical component permissible range is 

15 passed through a low-pass filter (i.e., a high-cut filter) to 
obtain the correcting perturbation model antiphase arm swing 
£ingle 9ca . 
[ 0 2 7 ] 

Ac:cording to the aforementioned second embodiment, in 
20 ^idditjon to the construction described in Japanese Unexamined 
Patent. Application Publication 5-337849 proposed by the present 
applic:ant, the behaviors of two motion modes having different 
generating ratios of a floor reaction force horizontal component 
aind the floor reaction force moment horizontal component about 
25 a desired ZMP, e.g., the body translational acceleration of the 
body translational motion mode and the body posture inclination 
emgle acceleration of the body inclination motion mode, are 
determined such that the translational force horizontal 
component of a floor reaction force does not exceed the 
30 permissible range of floor reaction force horizontal component, 
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thus allowing the actual robot 1 to converge to a corrected 
desired gait (the gait lastly output from the gait generator 100) . 
This means that the posture of the actual robot 1 can be 
stabi I. ized . 
5 [1028] 

Tne di f ference between a desired floor reaction force moment 
horizontal component for compliance control and a model 
manipulation floor reaction force moment horizontal component 
provides a total restoring force. 
10 [1029] 

The model manipulation floor reaction force moment 
horizontal component can take any value, ignoring the range in 
which a ZMP can exist, so that it is possible to generate an 
extremely high restoring force. 
15 [1030] 

The translational force horizontal component of a floor 
reaction force does not exceed the permissible range of a floor 
reaction force horizontal component, making it possible to 

prevent slippages of the robot 1. 
20 [10311 

A floor reaction force moment vertical component (a desired 
floor reaction force moment vertical component for compliance 
control) and eventually an actual floor reaction force moment 
vertical component do not exceed the permissible range of floor 
25 react ion force moment vertical component, making it possible to 
effec:t further prevention of slippages of the robot 1., 
: 1032 ] 

During a period in which a floor reaction force vertical 
component is zero, that is, during a period in which neither of 
30 both legs 2 and 2 is in contact with the ground, posture 
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r e s t o]:a t i on depending on a body rotation motion mode is carried 
out witnout depending on the body transla tional motion mode, so 
that the posture restoration is effectively implemented without 
dependence on the frictional force between a floor and the foot 
5 22 . 

[:.033; 

An actual floor reaction force moment can be prevented from 
undul\^ .increasing, thus making it possible to prevent or restrain 
the occurrence of a problem, such as deteriorated intrinsic 
10 ground contacting property of the foot 22 or the sole of the foot 
2 2 f 1 oa ting . 
[:-034] 

A current time gait parameter is determined or changed such 
t:hat a new current time gait using the terminal state of a 
15 correc.:ted gait for one step as its initial state gradually 
approximates to a normal gait, thus making it possible to continue 
generating gaits with continuously (long-term) ensured 
s tabi .1 i ty . 
[ ].030] 

20 In ^he aforementioned third embodiment, as described above, 

an original gait and a corrected gait are simultaneously 
generated, and the corrected gait is corrected to stabilize the 
postuie of the actual robot 1. In addition, if there is still 
ctn allowance after generating the floor reaction force moment 

25 (a horizontal component and a vertical component) necessary for 
posture restoration by compliance control, then this allowance 
is used to converge to the original gait within a possible range. 
Hence, in addition to the advantages of the second embodiment, 
it is possible to generate a gait that is close to the original 

30 gait initially set, i.e., the gait as per an initial request. 
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^rhus, if there is a preset travel path, significant deviation 
f.rom the travel path can be prevented. Furthermore, a priority 
is given to the convergence of the body posture angle of a 
correc:ted gait to the body posture angle of the original gait 
5 (originally determined gait) rather than to the convergence of 
the horizontal body position of a corrected gait to the horizontal 
body position of the original gait (originally determined gait) , 
makincf it possible to restrain a body posture angle from 
considerably varying. 
10 [10 3 6] 

In the aforementioned first to seventh embodiments, the 
floor reaction force horizontal component permissible range has 
been set. Alternatively, however, since a floor reaction force 
horizc-ntal component and the total center-of -gravi ty horizontal 
15 aiccel€-ra ti on of the robot share a proportional relationship, the 
total center-of -gravity horizontal acceleration of the robot and 
its permissible range may be used in place of the floor reaction 
force horizontal component and its permissible range in each of 
the aforesaid embodiments. Furthermore, a parameter related to 

20 the h(^i: i zc^ntal acceleration trajectory of a part having a 
behavior close to a total center-of -gravi ty horizontal 
trajectory of the robot may be explicitly set. For instance, 
if the mass of the legs 2 and 2 is sufficiently smaller than the 
mass of the body 3, then the body horizontal acceleration 

25 trajectory and the total center-of -gravity horizontal 
acceleration trajectory of the robot 1 are substantially 
identical or have a proportional relationship. Therefore, the 
body horizontal acceleration and its permissible range may be 
used in place of a floor reaction force horizontal component and 

30 its permissible range. 

-381 - 



[ :,037 ] 

Simil£irly, the floor reaction force vertical component and 
the vertical component of change rate of the total angular 
moment. um of the robot have a proportional relationship; 
5 thereiore, it is acceptable to use the vertical component of 
change: rate of the total angular momentum of the robot and a 
permis.sible range thereof may be used in place of the floor 
^reaction force moment vertical component and the permissible 
range thereof. 
iO [1038] 

Moreover, when generating gaits for traveling on a slope 
(when moving the robot 1 on an inclined floor surface) , the floor 
surface parallel component (the component parallel to the floor 
surface) of a translational floor reaction force, that is, the 
15 permissible range of a frictional force, or the permissible range 
of the floor surface parallel component of a total 
center -of -gravity acceleration (this is proportional to a 
frictional force, provided a gravity component is excluded) may 
be set in place of the floor reaction force horizontal component 

20 permissible range or the permissible range of total 
center-of -gravity acceleration horizontal component. An 
explanation of, for example, a case where the permissible range 
of a floor surface parallel component (frictional force) of a 
translational floor reaction force is set will be given (this 

25 explanation applies also to the case where the permissible range 
of the floor surface parallel component of a total 
center~of -gravity acceleration is set). For the frictional 
force, the relationship of Equation c72 given below holds when 
the inc:lination angle with respect to the horizontal plane of 

30 the floor surface is denoted by 6f {defined as positive for a 
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siop€5 inclining forward in the direction in which the robot 1 
£idvanc:es) . Hence, to generate a gait according to the algorithm 
similar to that in the aforementioned embodiment, a frictional 
force permissible range may be converted into a floor reaction 
force horizontal component permissible range by using the 
2:eiat.i onship of the Equation c72 so as to set the floor reaction 
force horizontal component permissible range. In this case, a 
de sired floor reaction force vertical component may be used as 
the floor reaction force vertical component in Equation c72 . 
[1039] 

Frictional force = Floor reaction force horizontal component 
^ cos{9f) - Floor reaction force vertical component * sin(0f)... 

Equation c72 
[10 4 0] 

In generating a gait for traveling on a slope (when moving 
the roDot 1 on an inclined floor surface) , the component in the 
direction of floor surface normal line of a floor reaction force 
mioment, i.e., the permissible range of a frictional force moment, 
may be set in place of a floor reaction force moment vertical 
component permissible range. For example, the relationship of 
Equation c73 given below holds for the frictional force moment 
when the inclination angle with respect to the horizontal plane 
of the floor surface is denoted by ef (defined as positive for 
a slope inclining forward in the direction in which the robot 
1 advances). Hence, to generate a gait according to the 
algorithm similar to that in the aforementioned embodiment, this 
relationship of Equation c73 may be used to calculate the 
frictional force moment from a floor reaction force moment 
vertical component and a floor reaction force moment horizontal 
component, and then the processing may be changed so that this 
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^^a]ue does not exceed the permissible range of the frictional 
force moment . 
[ ] 0 4 1 ] 

Frictional force moment = Floor reaction force moment vertical 
c:ompor.ent cos(6f) + Floor reaction force moment horizontal 
component ^ sin(0f) 

... Equation c7 3 

[10 4 2] 

In the aforementioned embodiments, the two motion modes, 
namely , the body inclination mode and the body translational mode, 
have been used to set the floor reaction force horizontal 
component and the floor reaction force moment horizontal 
component about a desired ZMP to proper values; however, 
different motion modes from them may alternatively be used. In 
this case, it is not required that one of the motion modes be 
a motion mode that does not generate a floor reaction force 
horizontal component. This is because, arbitrary floor reaction 
force liorizontal component and floor reaction force moment about 
a desired ZMP can be generated as in the above example by any 
combination of modes as long as two motion modes that generate 
a floor reaction force horizontal component and a floor reaction 
force TLoment about a desired ZMP at different ratios are used. 

[1043] 

Furthermore, a motion mode other than a body posture may be 
used. However, a motion mode should be selected that permits 

generation of a large floor reaction force horizontal component 
or a l^irge floor reaction force moment about a desired ZMP with 
a minimum of displacement as much as possible. 
[10 4 4] 

For instance, a motion mode for swing right and left arms 
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±n the same rotational direction or a motion for perturbating 
the position of a foot not in contact with the ground (floating) 
may be selected. Howev€:ir, if a free leg trajectory is to be 
pertuibated, the perturbation amount should be reset virtually 
to zero by immediately before landing so as not to disturb a 
J.andir.g position. 
[1 0 4 5] 

Alternatively;, three or more motion modes may be used. 
[1 046] 

The ratios of generating a floor reaction force horizontal 
component and a floor reaction force moment about a desired ZMP 
of at least two of selected modes must be different from each 
other. Otherwise^ in general, no solution of a simultaneous 

equation will be obtained. 
[1047] 

In addition, it is desirable to combine, as much as possible, 
a motion mode that allows a sufficiently large change to take 
place in the floor reaction force moment about a desired ZMP 
without changing a flooi" reaction force horizontal component 
much, and £i motion mode that allows a sufficiently large change 
to taka place in the floor reaction force horizontal component 
without changing a floor reaction force moment about a desired 
ZMP much. 

[1048] 

In other words, it is desirable to combine a motion mode that 
allows a sufficiently large change to take place in an angular 
momentum without changing a total center of gravity much and a 
motion mode^ that allows a sufficiently large change to take place 
in the total center of gravity without changing the angular 
momentum much . This is because displacements in the motion modes 
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w i 1 .1 Jce s IT; a Her. 
[10 4 9] 

Ir. the aforementioned embodiment, the antiphase arm swing 
mode has been used to set the floor reaction force moment vertical 
component to a proper value; however, other motion mode may be 
used. For example, the body yaw rotation mode may be used. 

[10 5 0] 

Further, it is not required that the motion mode used to set 
the floor reaction force moment vertical component to a proper 
value be a motion mode that does not generate a floor reaction 
force horizontal component and a floor reaction force moment 
horizontal component. For instance, a motion mode for swing a 
free leg back and forth may be used. This is because the floor 
reaction force horizontal component and the floor reaction force 
moment horizontal component generated by the motion mode can be 
offset by adjusting the two motion modes, namely, the body 
inclination mode and the body trans la tional mode. 

[1051] 

In addition to the dynamic model used in the aforementioned 
embodiments, the following models may be used as the 
aforementioned simplified models. 

1) A nonlinear model having mass points set on a plurality 
of links, as shown in Fig. 11 (multi-mass-point model) 

2) Three-mass-point model disclosed in Japanese Patent 
Application No. 2000-352011 by the present applicant 

3) One-mass-point model having a mass only in the body 

4) Model that ignores the moment of the inertial force 
generated by a change in the angular momentum about a total center 
of gravity 

5) Separate type model that separately has a partial model 
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representing the relationship between a resultant force of 
Gravity and an inertial force (or a floor reaction force) and 
a body trans lational motion, and a partial model representing 
the relationship between the above resultant force and a body 
5 rotational motion. For instance, the mass points shown in Fig. 
10 constitute a partial model indicating the relationship 
between the above resultant force and a body trans lational motion, 
and the flywheel shown in Fig. 10 is a partial model indicating 
the relationship between the above resultant force and a body 
lO rotational motion. 
[1052] 

Hcwever, for an embodiment in which a simplified model body 

posture inclination angle correcting moment is added to a 
simplified model, the models of 2), 3) and 4) above cannot be 
15 used. 

[1053] 

Preferably, a full model basically uses a dynamic model 
having a higher approximation accuracy than that of a simplified 
model; however, a dynamic model having an approximation accuracy 
1!0 equivalent to that of a simplified model may be used. 
[1054] 

Furthermore, in the embodiments described above, the block 
diagrams, the flowcharts, the algorithms and the like may be 
subjected to equivalent modifications, such as changing the 
25 order of calculation processing. In addition, low-pass filters 
m.ay be inserted, as necessary. 
[1055] 

The aforementioned embodiments have been explained in 
conjunction with bipedal mobile robots; however, the present 
30 invention can be applied also to one-foot or multi-leg robots 
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having t-hre^e or more legs. 

[BRIEF DESCRIPTION OF THE DRAWINGS] 

Fig. 1 is an explanatory view of an embodiment of the present 
invention ; 

Fig. 2 is an explanatory view of an embodiment of the present 

invention ; 

Fig. 3 is an explanatory view of an embodiment of the present 
invention; 

Fig. 4 is an explanatory view of an embodiment of the present 
invention ; 

Fig. 5 is an explanatory view of an embodiment of the present 

invention; 

Fig. 6 is an explanatory view of an embodiment of the present 
invent ion ; 

Fig. 7 is an explanatory view of an embodiment of the present 
invent ion ; 

Fig. 8 is an explanatory view of an embodiment of the present 
invent ion ; 

Fig. 9 is an explanatory view of an embodiment of the present 
i nvent ion ; 

Fig. 10 is an explanatory view of an embodiment of the present 
invention ; 

Fig. 11 is an explanatory view of an embodiment of the present 
invention ; 

Fig . 12 is an explanatory view of an embodiment of the present 

invention ; 

Fig. 13 is an explanatory view of an embodiment of the present 
invention ; 

Fig . 14 is an explanatory view of an embodiment of the present 
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i n V e n 1 1. o n ; 

Fig , 1 .'^ is an explanatory view of an embodiment of the present 
inven t i on ; 

Fig. 16 is an explanatory view of an embodiment of the present 

invention ; 

Fig. 1"/ is an explanatory view of an embodiment of the present 

invent i on ; 

Fig. IB is an explanatory view of an embodiment of the present 
invention; 

Fig . 1 9 i s an explanatory view of an embodiment of the present 

invention ; 

Fig . 2 0 is an explanatory view of an embodiment of the present 

invention ; 

Fig. 21 is an explanatory view of an embodiment of the present 
inven t ion ; 

Fig. 22 is an explanatory view of an esmbodiment of the present 
invention ; 

Fig . 23 is an explanatory view of an embodiment of the present 

invention ; 

Fig . 24 is an explanatory view of an embodiment of the present 

i n vent ic^n ; 

Fig . 2S is an explanatory view of an embodiment of the present 
inven t ion ; 

Fig . 26 is an explanatory view of an embodiment of the present 

invention ; 

Fig . 2 7 is an explanatory view of an embodiment of the present 

1 n V e n 1 1 c:) n ; 

Fig . 28 is an explanatory view of an embodiment of the present 
invent ion ; 

E"ig. 29 is an explanatory view of an embodiment of the present 
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i nven t ion ; 

Fig. 30 is an explanatory view of an embodiment of the present 
invention ; 

Fi g . 31 is an explanatory view of an embodiment of the present 
5 invention; 

Fi g . 32 is an explanatory view of an embodiment of the present 

i nven t ion ; 

Fig. 33 is an explanatory view of an embodiment of the present 
inven t i on ; 

10 Fig . 34 is an explanatory view of an embodiment of the present 

invention ; 

Fig. 35 is an explanatory view of an embodiment of the present 

invent i on ; 

Fig. 3 6 is an explanatory view of an embodiment of the present 
15 inventions- 
Fig . 37 is an explanatory view of an embodiment of the present 
invention ; 

Fig . 3 8 is an explanatory view of an embodiment of the present 
invention ; 

20 Fig. 3 9 i s an explanatory view of an embodiment of the present 

invention ; 

Fig. 40 is an explanatory view of an embodiment of the present 
invention ; 

Fig. 41 is an explanatory view of an embodiment of the present 
25 invention; 

Fig. 42 is an explanatory view of an embodiment of the present 

i n v e n t i <3 n ; 

Fig . 43 is an explanatory view of an embodiment of the present 
invention ; 

30 Fig. 4 4 is an explanatory view of an embodiment of the present 
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invention; 

F:i g . 4 5 is an explanatory view of an embodiment of the present 
i n ven t ion ; 

Fi g , 4 6 is an explanatory view of an embodiment of the present 
i nvent ion ; 

Fi g . 4 7 is an explanatory view of an embodiment of the present 

i nvent i on ; 

Fi g. 43 is an explanatory view of an embodiment of the present 
invent ion ; 

Fig . 4 9 is an explanatory view of an embodiment of the present 
invent ion ; 

Fi.g . 50 is an explanatory view of an embodiment of the present 

i.nvent ion ; 

Fi.g. 51 is an explanatory view of an embodiment of the present 
invent ion ; 

F::.g . 52 is an explanatory view of an embodiment of the present 
invent, ion; 

Fog . 53 is an explanatory view of an embodiment of the present 

onvent.ion ; 

Fog . 54 is an explanatory view of an embodiment of the present 
i nvent. ion ; 

F:.g . 55 is an explanatory view of an embodiment of the present 
onvent.ion; 

Fog . 56 is an explanatory view of an embodiment of the present 

onvent.ion ; 

Fog. 57 is an explanatory view of an embodiment of the present 

o nvent, ion; 

Fog . 58 is an explanatory view of an embodiment of the present 

onvent.ion ; 

Fog . 59 is an explanatory view of an embodiment of the present 
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i nven t i on ; 

F.i g . 60 is an explanatory view of an embodiment of the present 
i n vent ion ; 

F 3 g . 6 L is an explanatory view of an embodiment of the present 
5 invention; 

Fig. 62 is an explanatory view of an embodiment of the present 

i.nvent ion ; 

Fig . 63 is an explanatory view of an embodiment of the present 
invent ion ; 

10 Fig . 64 is an explanatory view of an embodiment of the present 

invent ion ; 

Fig . 65 is an explanatory view of an embodiment of the present 

invent i on ; 

F:.g . 66 is an explanatory view of an embodiment of the present 
15 invent.ion; 

F:_g . 67 is an explanatory view of an embodiment of the present 
invent.ion ; 

Fig . 68 is an explanatory view of an embodiment of the present 

invent, ion ; 

20 Fig . 69 is an explanatory view of an embodiment of the present 

invent, ion ; 

Fig. 70 is an explanatory view of an embodiment of the present 
invent:i on ; 

Fig . 7 1 is an explanatory view of an embodiment of the present 
25 invention; 

FLg. 72 is an explanatory view of an embodiment of the present 

.Invent ion; 

F Lq . 7 3 is an explanatory view of an embodiment of the present 
invention; 

30 Fiq. 74 is an explanatory view of an embodiment of the present 
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i n V e n t i o n ; 

Fi g . 7 5 is an explanatory view of an embodiment of the present 
invent i on ; 

Fig . 7 6 is an explanatory view of an embodiment of the present 

d.n vent i on ; 

Fi g . 7 7 is an explcinatory view of an embodiment of the present 

invent i on ; 

F„g . 78 is an explanatory view of an embodiment of the present 
invent. ion ; 

F:.a . 7 9 is an explanatory view of an embodiment of the present 

invent: ion ; 

Fig . 80 is an explanatory view of an embodiment of the present 

.Lnvent, 1 on ; 

Fig . 81 is an explanatory view of an embodiment of the present 
invent, i on ; 

Fig . 82 is an explanatory view of an embodiment of the present 

invent: i on ; 

Fig . 8 3 is an explanatory view of an embodiment of the present 

inven i on ; 

Fig. 84 is an explanatory view of an embodiment of the present 
inven zion ; 

Fig . S 5 is an explanatory view of an embodiment of the present 

inven t ion ; 

Fig. 86 is an explanatory view of an embodiment of the present 

invention ; 

Fig . 87 is an explanatory view of an embodiment of the present 

invent ion ; 

Fig . 8 8 is an explanatory view of an embodiment of the present 
i nvent ion ; 

Fig. 89 is an explanatory view of an embodiment of the present 
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i n ven t i on ; 

Fi g . 90 is an explanatory view 
invention . 

5 [DESCRIPTION OF NUMERALS] 

1: legged mobile robot; 2: leg; 3: 



of an embodiment of the present 



body; 5: arm; 60: control unit 
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[NAME OF DOCUMENT] ABSTRACT 
[ABSTRACT] 

[OBJECT I The present invention is to provide a control device 
and a gait generation device capable of generating a further ideal 
5 gait regardless of gait types, such as walking and running, and 

a friction condition of a floor surface. 

[MEANS FOR ACHIEVING THE OBJECT] A permissible range of a 
restriction object amount, namely a vertical component of a floor 
reaction force moment or the like applied to the robot 1, is set. 
10 On the basis of at least a difference between a desired state 
amount related to a posture of a robot 1 about a vertical axis 
floor surface normal line axis and an actual state amount 
f the robot 1 and the permissible range, instantaneous values 
of a desired motion and a desired floor reaction force are 
15 determined such that a difference between a floor reaction force 
moment balancing with the desired motion on a dynamic model and 
a f locr reaction force moment of the desired floor reaction force 
approximates the aforesaid difference to zero, while having the 
restrLction object amount, which is associated with the desired 
20 floor reaction force, fall within the permissible range. 
[SELECTED DRAWING] FIG. 1 
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FIG.9 

(BODY ROTATION MODE) 
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FIG.10 

(FLYWHEEL MODEL) 
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FIG.13 
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FIG.16 

(DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT) 
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(FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE) 
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FIG.18 

(DESIRED ZMP) 
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_^ FIG.19 ^^/^^ 

3 (SEARCHING OF INITIAL DIVERGENT COMPONENT OF NORMAL GAIT) 



S200 



DETERMINE INITIAL STATES (STATES AT START TIME Ts) OF FOOT POSITION/POSTURE, ARM 
POSTURE AND BODY POSTURE ANGLE ON THE BASIS OF NORMAL TURNING GAIT PARAMETERS. 



PROVISIONALLY DETERMINE INITIAL (AT Ts) HORIZONTAL 
BODY POSITION/VELOCITY CANDIDATES (Xs.Vxs). 



S202 



S204 



DETERMINE INITIAL VERTICAL BODY POSITION/VELOCITY (Zs, Vzs). | 



S206 



S208 



USING DYNAMIC MODEL, GENERATE ONE STEP OF GAIT ON THE BASIS OF NORMAL 
TURNING GAIT PARAMETERS, TAKING (Xs.Vxs), (Zs.Vzs) AS INITIAL STATES OF BODY. 



CONVERT TERMINAL BODY POSITION/VELOCITY OF GENERATED GAIT INTO 
VALUES OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM OF NEXT 
ONE STEP, AND DEFINE THE VALUES AS (Xe,Vxe). 



S210 



BOUNDARY CONDITION ERROR (errx,errv)=(Xs,Vxs)-(Xe,Vxe) 



S212 



S214 yes 



ARE errx AND errv WITHIN 
PERMISSIBLE RANGE? 



< LEAVE REPETITION LOOP ) 



S216 



DETERMINE A PLURALITY OF INITIAL VALUE CANDIDATES (Xs+ A Xs,Vxs),(Xs,Vxs+ A Vxs) 
NEAR (Xs.Vxs), AND TAKE EACH OF THE DETERMINED VALUES AS INITIAL STATE OF BODY 
TO DETERMINE BOUNDARY CONDITION ERROR ASSOCIATED WITH EACH AS SHOWN ABOVE. 



DETERMINE NEXT INITIAL VALUE CANDIDATES (Xs.Vxs) ON THE BASIS OF 
BOUNDARY CONDITION ERRORS ASSOCIATED WITH (Xs.Vxs) AND INITIAL 
VALUE CANDIDATES IN THE VICINITY THEREOF. 



S218 



DETERMINE INITIAL HORIZONTAL BODY POSITION/VELOCITY (XO,VO), 
INITIAL VERTICAL BODY POSITION/VELOCITY (ZO.VzO), 

AND INITIAL BODY POSTURE ANGLE/ANGULAR VELOCITY AT ORIGINAL START TIME 0. 



S220 



DETERMINE NORMAL TURNING INITIAL DIVERGENT COMPONENT q[0] 

ACCORDING TO THE FOLLOWING EQUATION: 

q[0] =X0 + VP/ CO 0 



S222 



S224 



DETERMINE qG() WHICH IS THE VALUE OF NORMAL TURNING INITIAL DIVERGENT COMPONENT 

q[0] OBSERVED FROM CURRENT TIMES GAIT SUPPORTING LEG COORDINATE SYSTEM, 
AND (ZOQDVzOGO, WHICH IS THE VALUES OF INITIAL VERTICAL BODY POSITION/VELOCITY 
OBSERVED FROM CURRENT TIMES GAIT SUPPORTING LEG COORDINATE SYSTEM. 



DETERMINE INITIAL ANTIPHASE ARM SWING ANGLE AND ANGULAR VELOCITY ( 6 azO, co azO) 
AT ORIGINAL START TIME 0, AND DETERMINE ( 0 azO® oj azOO^. WHICH IS THE VALUES OF 
THE ABOVE OBSERVED FROM CURRENT TIMES GAIT SUPPORTING LEG COORDINATE SYSTEM. 



S226 



C RETURN ^ 
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ENTRY 



FIG.20 

(GENERATION OF PROVISIONAL GAIT OF NORMAL GAIT) 



S300 



INITIALIZATION 

TIME FOR GENERATING PROVISIONAL GAIT k 

=Ts (Ts: NORMAL GAIT CALCULATION START TIME) 
HORIZONTAL BODY POSITION/VELOCITY = (Xs.Vxs) 
VERTICAL BODY POSITION/VELOCITY = (Zs.Vzs) 
BODY POSTURE ANGLE = REFERENCE BODY POSTURE ANGLE INITIAL VALUE 
BODY POSTURE ANGULAR VELOCITY 

= REFERENCE BODY POSTURE ANGULAR VELOCITY INITIAL VALUE 
ANTIPHASE ARM SWING ANGLE = REFERENCE INITIAL ANTIPHASE ARM SWING ANGLE 
ANTIPHASE ARM SWING ANGULAR VELOCITY 

= REFERENCE INITIAL ANTIPHASE ARM SWING ANGULAR VELOCITY 



S306 



S302 



S304 yes 



- k < Ts + Tcyc ? 



SUBROUTINE FOR DETERMINING 
NORMAL GAIT INSTANTANEOUS VALUE 



k=k+Ak 



S308 



S310 



DETERMINE BODY INCLINATION RESTORING MOMENT ZMP CONVERTED VALUE PATTERN, 
AND INITIAL BODY POSTURE ANGLE AND ANGULAR VELOCITY OF NORMAL GAIT SUCH 
THAT BODY POSTURE ANGULAR VELOCITY AT START AGREES WITH THAT AT END. 



BASED ON BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PAHERN. 
DETERMINE AMOUNT OF INFLUENCE THEREBY ON HORIZONTAL BODY POSITION/VELOCITY, 
AND ADD THE RESULT TO TERMINAL BODY HORIZONTAL POSITION/VELOCITY. 



S312 



DETERMINE ANTIPHASE ARM SWING RESTORING ANGULAR ACCELERATION PAHERN SUCH 
THAT ANTIPHASE ARM SWING ANGULAR VELOCITY AT START AGREES WITH THAT AT END. 



S314 



DETERMINE INITIAL ANTIPHASE ARM SWING ANGLE 
AND ANGULAR VELOCITY OF NORMAL GAIT. 



S316 



C RETURN ^ 
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FIG.21 

(DETERMINATION OF INSTANTANEOUS VALUES OF NORMAL GAIT) 

S400 



DETERMINE DESIRED FLOOR REACTION FORCE VERTICAL 
COMPONENT AT TIME k ON THE BASIS OF GAIT PARAMETERS 



DETERMINE DESIRED ZMP AT TIME k 
ON THE BASIS OF GAIT PARAMETERS. 



S402 



S404 



DETERMINE DESIRED POSITIONS/POSTURES OF BOTH FEET, REFERENCE BODY 
POSTURE AND REFERENCE ARM POSTURE AT TIME k ON THE BASIS OF GAIT PARAMETERS. 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION/VELOCITY 
THAT SATISFY DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT. 



S406 



CALCULATE VERTICAL BODY POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION. 



S408 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE 
RANGE [Fxmin,Fxmax] AT TIME k ON THE BASIS OF GAIT PARAMETERS. 



S410 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE 
RANGE [Mzmin,Mzmax] AT TIME k ON THE BASIS OF GAIT PARAMETERS. 



S411 



S412 



DETERMINE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION SUCH THAT DESIRED ZMP IS SATISFIED AND THAT FLOOR REACTION FORCE 
HORIZONTAL COMPONENT Fx DOES NOT EXCEED [Fxminjxmax], AND DETERMINE 
ANTIPHASE ARM SWING ANGULAR ACCELERATION SUCH THAT FLOOR REACTION FORCE 
MOMENT VERTICAL COMPONENT Mz DOES NOT EXCEED [Mzmin.Mzmax]. 



S414 



INTEGRATE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION 
TO CALCULATE HORIZONTAL BODY VELOCITY AND BODY POSTURE ANGULAR VELOCITY. 
FURTHER INTEGRATE THE RESULT TO DETERMINE HORIZONTAL BODY POSITION 
AND BODY POSTURE. 



INTEGRATE ANTIPHASE ARM SWING ACCELERATION 

TO CALCULATE ANTIPHASE ARM SWING ANGULAR VELOCITY. 

FURTHER INTEGRATE THE RESULT TO DETERMINE ANTIPHASE ARM SWING ANGLE. 



S416 



( RETURN ^ 



C ENTRY 
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(DETERMINATION OF HORIZONTAL BODY ACCELERATION/ BODY POSTURE ANGULAR ACCELERATION OF 



-^ FIG.22 



SUBSTITUTE THE VALUE OF REFERENCE BODY YAW ANGLE AT TIME k INTO DESIRED BODY YAW ANGLE. 

EXCLUDING ANTIPHASE ARM SWING ANGLE AND ANGULAR VELOCITY, 

SUBSTITUTE THE VALUE OF REFERENCE ARM POSTURE AT TIME k INTO DESIRED ARM POSTURE. 



S500 



S502 



no 



IS TIME k IN BODY 
POSTURE 

ANGLE/ANTIPHASE 
ARM SWING 
ANGLE 
RESTORING 
PERIOD? 



yes 



C RETURN ^ 



DETERMINE HORIZONTAL BODY ACCELERATION a tmp REQUIRED TO 
SATISFY DESIRED ZMP FOR CURRENT TIME (AT TIME k) IF IT IS ASSUMED 
THAT MOTION OF BODY TRANSLATIONAL MODE IS PERFORMED. 



S504 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT 
Fxtmp WHEN HORIZONTAL BODY ACCELERATION IS a tmp. 



S506 



S510 



S508 Fxtmp > Fxmax 



DETERMINE HORIZONTAL COMPONENT Fx OF FLOOR 
REACTION FORCE ACCORDING TO THE FOLLOWING EQUATION: 
Fx = Fxmax 



else 



Fx = 


Fxmin | 


Fx- 


Fxtmp 1 



S514 



S516 



DETERMINE HORIZONTAL BODY ACCELERATION a OF BODY TRANSLATIONAL MODE 
AND BODY ANGULAR ACCELERATION 0 OF BODY ROTATION MODE ACCORDING 

TO THE FOLLOWING EQUATIONS: 

n = (v tmp+ (Fx — Fxtmp) / AFp 

p = ( g tmp — g ) * A Mp / A Mr 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT Mztmp WHEN 
IT IS ASSUMED THAT MOTION OF HORIZONTAL BODY ACCELERATION OF BODY 
TRANSLATIONAL MODE DENOTED AS a , BODY ANGULAR ACCELERATION OF BODY 
ROTATION MODE DENOTED /3 , BODY YAW ANGULAR ACCELERATION OF BODY YAW 
ROTATION MODE DENOTED AS 0 bref, AND ANTIPHASE ARM SWING ANGULAR 
ACCELERATION DENOTED AS B aref IS PERFORMED. 



S518 



S522 



S520 Mztmp > Mzmax 



Mztmp ? 



Mztmp < Mzmin 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL 
COMPONENT Mz ACCORDING TO THE FOLLOWING EQUATION: 

Mz = Mzmax 



else 



Mz = Mzmin | S524 
Mz = Mztmp I S526 



DETERMINE ANTIPHASE ARM SWING ANGULAR ACCELERATION B a 
ACCORDING TO THE FOLLOWING EQUATION: 

i3a= /^aref+ (Mz- Mztmp) /A Ma 



S528 



S530 



DETERMINE HORIZONTAL BODY ACCELERATION a REQUIRED TO SATISFY DESIRED ZMP FOR 
CURRENT TIME (AT TIME k) IF MOTION OF BODY TRANSLATIONAL MODE IS PERFORMED. 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT Fx 
WHEN HORIZONTAL BODY ACCELERATION IS a . 



S532 



a =0 



S534 



/^a= /Saref 



S536 
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FIG.23 



FLOOR REACTION FORCE HORIZONTAL COMPONENT Fxtmp 
CREATED WITHOUT TAKING PERMISSIBLE RANGE INTO ACCOUNT 



PERMISSIBLE RANGE 




FLOATING 
PERIOD 



FLOATING 
PERIOD 



FIG.24 

FLOOR REACTION FORCE HORIZONTAL COMPONENT Fx 
TAKING FLOOR REACTION FORCE HORIZONTAL COMPONENT 
PERMISSIBLE RANGE INTO ACCOUNT 



PERMISSIBLE RANGE 




FLOATING 
PERIOD 



Tm 



Ts2 FLOATING 
PERIOD 



FIG.25 



BODY INCLINATION ANGULAR ACCELERATION /:! 



Ts 



FLOATING 
PERIOD 



Tm 



Ts 




FLOATING 
PERIOD 



Tm2 
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FIG.26 



BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE (ZMPrec) 
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PERIOD 
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FIG.27 

BODY INCLINATION ANGULAR ACCELERATION [i 

(FOR RETURNING BODY INCLINATION VELOCITY TO INITIAL VALUE) 



Ts 



FLOATING 
PERIOD 
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FLOATING 
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FIG.28 

(RELATIONSHIP OF BODY POSITIONS IN NORMAL GAIT ON LANDING) 



NEXT TIME'S GAIT 
SUPPORTING LEG 
COORDINATE 
SYSTEM 
Y' 



22R 

CURRENT TIME'S GAIT 
SUPPORTING LEG 
COORDINATE 
SYSTEM 



Xe=Xs 




Ye=Ys 

-22R 

NEXT BUT ONE TIME'S GAIT 
SUPPORTING LEG 
COORDINATE 
SYSTEM 



BODY TRAJECTORY OF NORMAL GAIT 

(FIRST TURNING GAIT + SECOND TURNING GAIT) 
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FIG.29 

(PROVISIONAL DETERMINATION OF PARAMETERS OF CURRENT TIME GAIT) 



c 



ENTRY 



DETERMINE FOOT TRAJECTORY PARAMETERS 
OF CURRENT TIME GAIT. 



DETERMINE REFERENCE BODY POSTURE TRAJECTORY 
PARAMETERS OF CURRENT TIME GAIT. 



DETERMINE REFERENCE ARM POSTURE TRAJECTORY 
PARAMETERS OF CURRENT TIME GAIT. 



S600 



S602 



S604 



DETERMINE FLOOR REACTION FORCE VERTICAL COMPONENT 
TRAJECTORY PARAMETERS OF CURRENT TIME GAIT. 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT 
PERMISSIBLE RANGE [Fxmin.Fxmax] OF CURRENT TIME GAIT. 



S606 



S608 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT 
PERMISSIBLE RANGE [Mzmin.Mzmax] OF CURRENT TIME GAIT. 



S610 



DETERMINE ZMP TRAJECTORY PARAMETERS 
OF CURRENT TIME GAIT. 



SET BODY INCLINATION ANGLE AND ANTIPHASE ARM 
SWING ANGLE RESTORING PERIOD [Tajb]. 



S612 



S614 



RETURN 
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FIG.30 

FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE 



FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE LOWER LIMIT VALUE Fxmin 
AND FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE UPPER LIMIT VALUE Fxmax 




FLOATING 
PERIOD 



ENTRY 
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F1G.31 

(CORRECTION OF PARAMETERS OF PROVISIONAL CURRENT TIME GAIT) 



S700 



CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL END TIME ON THE BASIS OF 
PROVISIONAL DESIRED ZMP AND OTHER CURRENT TIME GAIT PARAMETERS. 



S702 



DETERMINE TERMINAL DIVERGENT COMPONENT qOIk] ACCORDING TO THE FOLLOWING 
EQUATION FROM BODY POSITION/VELOCITY (Xe.Vxe) AT END OF CURRENT TIME GAIT. 

qO[k] = Xe + Vxe / oj 0 



S704 



DETERMINE TERMINAL DIVERGENT COMPONENT ERROR errq 

ACCORDING TO THE FOLLOWING EQUATION: 

errq = qO[k] - q" 



S706 



S708 yes 



IS errq WITHIN PERMISSIBLE RANGE? <^ 



LEAVE REPETITION LOOP ^ 



S710 



CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL END TIME ON THE BASIS OF DESIRED ZMP 
OBTAINED BY ADDING CORRECTION TO PROVISIONAL DESIRED ZMP ACCORDING 
TO RELATIONSHIP OF FIG. 44, ASSUMING THAT a= A a. 



S712 



DETERMINE TERMINAL DIVERGENT COMPONENT q1 [k] ACCORDING TO THE FOLLOWING EQUATION 
ON THE BASIS OF BODY POSITION/VELOCITY (Xe1,Vxe1) AT END OF CURRENT TIME GAIT 
RECALCULATED ON THE BASIS OF DESIRED ZMP TO WHICH CORRECTION HAS BEEN ADDED: 

q1[k] = Xel + Vxel / coO 



DETERMINE PARAMETER SENSITIVITY r ACCORDING TO THE FOLLOWING EQUATION: 
r= (qlfkl -qO[k])/Aa 



S714 



ADD CORRECTION AMOUNT BASED ON a=-errq/r TO PROVISIONAL 
DESIRED ZMP TO PROVIDE UPDATED PROVISIONAL DESIRED ZMP. 



S716 



S718 



DETERMINE BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PAHERN ON THE BASIS OF 
DIFFERENCE BETWEEN TERMINAL BODY POSTURE ANGLE OF PROVISIONAL CURRENT TIME GAIT AND INITIAL 
BODY POSTURE ANGLE OF NORMAL GAIT AND DIFFERENCE BETWEEN TERMINAL BODY POSTURE ANGULAR 
VELOCITY OF PROVISIONAL CURRENT TIME GAIT AND INITIAL BODY POSTURE ANGULAR VELOCITY 
OF NORMAL GAIT. 



DETERMINE, AS DESIRED ZMP PATTERN, THE PAHERN OBTAINED BY ADDING BODY INCLINATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PAHERN TO PROVISIONAL DESIRED ZMP PAHERN. 



S720 
S722 



DETERMINE ANTIPHASE ARM SWING RESTORING ANGULAR ACCELERATION PAHERN ON THE BASIS 

OF DIFFERENCE BETWEEN TERMINAL ANTIPHASE ARM SWING ANGLE OF PROVISIONAL CURRENT TIME 
GAIT AND INITIAL ANTIPHASE ARM SWING ANGLE OF NORMAL GAIT AND DIFFERENCE BETWEEN TERMINAL 
ANTIPHASE ARM SWING ANGULAR VELOCITY OF PROVISIONAL CURRENT TIME GAIT AND INITIAL 

ANTIPHASE ARM SWING ANGULAR VELOCITY OF NORMAL GAIT. 
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FIG.32 

^(GENERATION OF PROVISIONAL CURRENT TIME GAIT) 

C ENTRY ^ 

S800 



INITIALIZATION 

TIME FOR GENERATING PROVISIONAL GAIT k=0 

TERMINAL STATE OF LAST TIMES DESIRED GAIT THAT HAS BEEN CONVERTED 

TO CURRENT TIMES GAIT SUPPORTING LEG COORDINATE SYSTEM IS TAKEN AS 

INITIAL STATE OF CURRENT TIMES GAIT 
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SUBROUTINE FOR DETERMINING INSTANTANEOUS 
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C RETURN ^ 
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ENTRY 



FIG.33 

(DETERMINATION OF HORIZONTAL BODY ACCELERATION/ BODY 
POSTURE ANGULAR ACCELERATION OF CURRENT TIME GAIT) 



SI 000 



SUBSTITUTE VALUE OF REFERENCE BODY YAW ANGLE AT CURRENT TIME INTO DESIRED BODY 
YAW ANGLE. EXCLUDING ANTIPHASE ARM SWING ANGLE AND ANGULAR VELOCITY, SUBSTITUTE 
VALUE OF REFERENCE ARM POSTURE AT CURRENT TIME INTO DESIRED ARM POSTURE. 



SI 002 



IS CURRENT TIME IN 
BODY INCLINATION 
ANGLE/ANTIPHASE 
ARM SWING 
RESTORING 
PERIOD [Tajb]? 



no 



yes 



SI 004 



CARRY OUT THE SAME PROCESSING AS PROCESSING (S504 TO S528) 
FOR CALCULATING HORIZONTAL BODY ACCELERATION a , BODY 
ANGULAR ACCELERATION . AND ANTIPHASE ARM SWING ANGULAR 
ACCELERATION j3 a IF CURRENT TIME IS NOT IN BODY INCLINATION 
ANGLE/ANTIPHASE ARM SWING ANGLE RESTORING PERIOD. 



SI 006 



DETERMINE HORIZONTAL BODY ACCELERATION a tmp REQUIRED 
TO SATISFY DESIRED ZMP AT CURRENT TIME (TIME k) IF MOTION 
OF BODY TRANSLATIONAL MODE IS PERFORMED. 



CALCULATE INSTANTANEOUS VALUE ZMPrec OF BODY 
INCLINATION RESTORING MOMENT ZMP-CONVERTED 
VALUE PAnERN AT CURRENT TIME. 



SI 008 



SI 010 



CALCULATE INSTANTANEOUS VALUE H arec OF ANTIPHASE ARM SWING 
RESTORING ANGULAR ACCELERATION PAHERN AT CURRENT TIME. 
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SI 01 6 



SI 01 4 



SI 01 8 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT Fx 
WHEN HORIZONTAL BODY ACCELERATION IS a. 
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FIG.34 

(CORRECTION OF DESIRED ZMP) 
PROVISIONAL DESIRED ZMP 
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FIG.36 

(BODY INCLINATION CENTERED AT WAIST) 
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FIG.37 

(GAIT) 




POSITION OF BODY IN 
VERTICAL DIRECTION 




FLOOR REACTION FORCE 
VERTICAL COMPONENT 



r^TIME 



^^TIME 
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FIG.38 

(GAIT) 




POSITION OF BODY IN 
VERTICAL DIRECTION 
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FIG.40 

(ANTIPHASE ARM SWING MODE) 
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FIG.41 

FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE 

FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE LOWER LIMIT VALUE Mzmin 
AND FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE UPPER LIMIT VALUE Mzmax 
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FIG.42 



Q ENTRY 3 (DETERMINATION OF INSTANTANEOUS VALUES OF CURRENT TIME GAIT) 

SI 400 



DETERMINE DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT 
AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



DETERMINE DESIRED ZMP AT CURRENT TIME 
ON THE BASIS OF GAIT PARAMETERS. 



SI 402 



SI 404 



DETERMINE DESIRED POSITIONS/POSTURES OF BOTH FEET, REFERENCE BODY POSTURE 
AND REFERENCE ARM POSTURE AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION/VELOCITY 
THAT SATISFIES DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT. 



SI 406 



CALCULATE BODY VERTICAL POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION. 



SI 408 



SI 410 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE 
RANGE [Fxinin,Fxmaxl AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE 
RANGE [Mzmin,Mzmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S1411 



S1412 



DETERMINE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION SUCH THAT DEISRED ZMP IS SATISFIED, FLOOR REACTION FORCE 
HORIZONTAL COMPONENT Fx DOES NOT EXCEED [Fxmin,Fxmax], AND BODY POSTURE 
ANGLE TRAJECTORY CONVERGES TO NORMAL GAIT, AND ALSO DETERMINE ANTIPHASE 
ARM SWING ANGULAR ACCELERATION SUCH THAT FLOOR REACTION FORCE MOMENT 
VERTICAL COMPONENT Mz DOES NOT EXCEED [Mzmin,Mzmax] AND ANTIPHASE ARM 
SWING ANGLE TRAJECTORY CONVERGES TO NORMAL GAIT. 



INTEGRATE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION TO CALCULATE HORIZONTAL BODY VELOCITY AND BODY POSTURE 
ANGULAR VELOCITY. FURTHER INTEGRATE THE RESULT TO DETERMINE HORIZONTAL 
BODY POSITION AND BODY POSTURE. 



S1414 



S1416 



INTEGRATE ANTIPHASE ARM SWING ACCELERATION TO CALCULATE ANTIPHASE ARM SWING 
ANGULAR VELOCITY. FURTHER INTEGRATE THE RESULT TO DETERMINE 
ANTIPHASE ARM SWING ANGLE. 
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FIG.43 

FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT Mztmp 
CREATED WITHOUT TAKING PERMISSIBLE RANGE INTO ACCOUNT 

PERMISSIBLE RANGE 




PERIOD PERIOD 



FIG.44 

FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT Mz 
TAKING FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT 
PERMISSIBLE RANGE INTO ACCOUNT 
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ANTIPHASE ARM SWING MOMENT (Maz) 
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FIG.46 

ANTIPHASE ARM SWING ANGULAR ACCELERATION H a 
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FIG.47 



ANTIPHASE ARM SWING RESTORING ANGULAR ACCELERATION ( /3 arec) 
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ANTIPHASE ARM SWING RESOTRING MOMENT (Mazrec) 
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FIG.49 

FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT Mz 
TAKING FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT 
PERMISSIBLE RANGE INTO ACCOUNT 



PERMISSIBLE RANGE 




41/77 



FIG.50 

FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE 

FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE LOWER LIMIT VALUE Mzmin 
AND FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE UPPER LIMIT VALUE Mzmax 
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FIG.51 

(FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE) 
REFERENCE ANTIPHASE ARM 

SWING ANGLE « azref SUM OF TURNING ANGLES 

OF FIRST TURNING GAIT 
AND SECOND TURNING GAIT 
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FIG.53 



COMPENSATING TOTAL 
FLOOR REACTION FORCE 
MOMENT HORIZONTAL 
COMPONENT Mdmdxy 
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MODEL MANIPULATION FLOOR 
REACTION FORCE MOMENT 

HORIZONTAL COMPONENT 



INPUT 



FLOOR REACTION 
FORCE MOMENT 
HORIZONTAL 
tCOMPONENT 
PERMISSIBLE RANGE 



SUM OF COMPENSATING FLOOR 
REACTION FORCE MOMENT 
HORIZONTAL COMPONENT 
Mdmdxy AND MODEL 
MANIPULATION FLOOR 
REACTION FORCE MOMENT 
HORIZONTAL COMPONENT 



(FLOOR REACTION FORCE 
MOMENT HORIZONTAL 
COMPONENT FOR 
COMPLIANCE CONTROL) 



FIG.54 



COMPENSATING TOTAL 
FLOOR REACTION FORCE 
MOMENT VERTICAL 
COMPONENT Mdmdz 




PERMISSIBLE RANGE OF 
FLOOR REACTION FORCE 
MOMENT VERTICAL 
COMPONENT 

COMPENSATION AMOUNT 



MODEL MANIPULATION FLOOR 
REACTION FORCE MOMENT 
VERTICAL COMPONENT 
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INITIALIZATION (t=0, ETC.) 



^^/^^ FIG.55 

(DETERMINATION OF INSTANTANEOUS VALUES OF CURRENT TIME GAIT) 
S3010 



S30 



S3014 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL CYCLE). 



S3016 yes 



IS GAIT 
CHANGING? 



END 



t = 0 



S3018 



S3020 



READ NEXT TIME GAITS SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAITS SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT CYCLE, AND NEXT TIME GAIT CYCLE. 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S3022 



S3024 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENT COMPONENT, INITIAL BODY POSITION/ VELOCITY, 
INITIAL BODY POSTURE ANGLE/ANGULAR VELOCITY, 
AND INITIAL ANTIPHASE ARM SWING ANGLE/ANGULAR VELOCITY) 



PROVISIONALLY DETERMINE GAIT PARAMETERS 
OF CURRENT TIME GAIT. 



S3026 



S3028 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETERS 
(CORRECT CURRENT TIME GAIT PARAMETERS SO THAT TERMINAL 
DIVERGENT COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENT COMPONENT OF NORMAL TURNING GAIT AND 
THAT ANTIPHASE ARM SWING ANGLE CONVERGES TO ANTIPHASE 
ARM SWING ANGLE TRAJECTORY OF NORMAL GAIT.) 



DETERMINE PARAMETERS OF FLOOR REACTION FORCE MOMENT 
HORIZONTAL COMPONENT PERMISSIBLE RANGE FOR COMPLIANCE 
CONTROL AND FLOOR REACTION FORCE MOMENT VERTICAL 
COMPONENT COMPENSATION AMOUNT PERMISSIBLE RANGE. 



S3030 



S3032 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF CURRENT TIME GAIT 

(DETERMINE IT SUCH THAT MODEL MANIPULATION FLOOR REACTION FORCE MOMENT 
HORIZONTAL COMPONENT IS GENERATED ABOUT DESIRED ZMP AND THAT FLOOR 
REACTION FORCE MOMENT VERTICAL COMPONENT DOES NOT EXCEED FLOOR 
REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE.) 



CORRECT INSTANTANEOUS VALUE OF CURRENT TIME GAIT. 
(CORRECT INSTANTANEOUS VALUE OF CURRENT TIME GAIT SUCH THAT MODEL 
MANIPULATION FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT IS 
ADDITIONALLY GENERATED ABOUT DESIRED ZMP.) 



S3034 



t=t+At 



S3036 
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FIG.56 

(SUPPORTING POLYGON AND ZMP PERMISSIBLE RANGE) 



ZMP PERMISSIBLE RANGE 
(FLOOR REACTION FORCE CENTRAL 
POINT PERMISSIBLE RANGE) 




RIGHT FOOT 
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{DETERMINATION OF INSTANTANEOUS VALUES OF CURRENT TIME GAIT) 
FIG.57 



DETERMINE DESIRED FLOOR REACTION FORCE VERTICAL 
COMPONENT AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S3400 



DETERMINE DESIRED ZMP AT CURRENT TIME 
ON THE BASIS OF GAIT PARAMETERS 



S3402 



S3404 



DETERMINE DESIRED POSITIONS/POSTURES OF BOTH FEET, REFERENCE BODY POSTURE AND 
REFERENCE ARM POSTURE AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION/VELOCITY 
THAT SATISFY DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT. 



S3406 



CALCULATE VERTICAL BODY POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION. 



S3408 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE 
[Fxmln,Fxmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S3410 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE 
[Mztnln,Mzmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S3411 
S3412 



DETERMINE FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE RANGE 

[Mxymin.Mxymax] AND FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT COMPENSATION 
AMOUNT PERMISSIBLE RANGE [Mzcmin,Mzcmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



DETERMINE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION 
SUCH THAT MODEL MANIPULATION FLOOR REACTION FORCE MOMENT IS GENERATED ABOUT DESIRED 
ZMP, FLOOR REACTION FORCE HORIZONTAL COMPONENT Fx DOES NOT EXCEED [Fxmin,Fxmax], AND 
BODY POSTURE ANGLE TRAJECTORY CONVERGES TO NORMAL GAIT, AND ALSO DETERMINE ANTIPHASE 
ARM SWING ANGULAR ACCELERATION SUCH THAT FLOOR REACTION FORCE MOMENT VERTICAL 
COMPONENT Mz DOES NOT EXCEED [Mzmin,Mzmax] AND ANTIPHASE ARM SWING ANGLE 
TRAJECTORY CONVERGES TO NORMAL GAIT. 



S3414 



INTEGRATE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION TO 

CALCULATE HORIZONTAL BODY VELOCITY AND BODY POSTURE ANGULAR VELOCITY. 

FURTHER INTEGRATE THE RESULT TO DETERMINE HORIZONTAL BODY POSITION AND BODY POSTURE. 



S3416 



S3418 



INTEGRATE ANTIPHASE ARM SWING ACCELERATION TO CALCULATE ANTIPHASE ARM SWING ANGULAR VELOCITY. 
FURTHER INTEGRATE THE RESULT TO DETERMINE MITIPHASE ARM SWING ANGLE. 



C RETURN ^ 



C ENTRY 



SUBSTITUTE THE VALUE OF REFERENCE BODY YAW ANGLE AT TIME k INTO DESIRED BODY 
YAW ANGLE. EXCLUDING ANTIPHASE ARM SWING ANGLE AND ANGULAR VELOCITY, 
SUBSTITUTE THE VALUE OF REFERENCE ARM POSTURE AT TIME k INTO DESIRED ARM POSTURE. 



IS TIME k IN 
BODY POSTURE 
ANGLE/ANTIPHASE 
ARM SWING 
ANGLE 
RESTORING 
ERIOD? 
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r I u . JO (DETERMINATION OF HORIZONTAL BODY ACCELERATION/ 



BODY POSTURE ANGULAR ACCELERATION) 



S3100 



S3104 



S3102 



no 



C RETURN ^ 



DETERMINE HORIZONTAL BODY ACCELERATION a tmp REQUIRED TO GENERATE MODEL 
MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT ABOUT 
DESIRED ZMP AT CURRENT TIME (TIME k) IF IT IS ASSUMED THAT MOTION OF BODY 
TRANSLATIONAL MODE IS PERFORMED 



S3108 Fxtmp>Fxniax 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT Fxtmp 
WHEN HORIZONTAL BODY ACCELERATION IS a imp. 



S3106 



S3110 



yes 



xtmp 



Fxtmp < Fxmin 




DETERMINE HORIZONTAL COMPONENT Fx OF FLOOR REACTION 
FORCE ACCORDING TO THE FOLLOWING EQUATION: Fx = Fxmax 



Fx = Fxmin 



Fx = Fxtmp 



S3112 
S3114 



S3116 



DETERMINE HORIZONTAL BODY ACCELERATION a OF BODY TRANSLATIONAL MODE 
AND BODY ANGULAR ACCELERATION /3 OF BODY ROTATION MODE ACCORDING TO 
THE FOLLOWING EQUATIONS: 

lmp+ (Fx— Fxtmp) / AFp 
ft = ( a tmp " a ) * A Mp / AMr 



S3118 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT Mztmp WHEN IT IS 
ASSUMED THAT MOTION OF HORIZONTAL BODY ACCELERATION OF BODY TRANSLATIONAL 
MODE DENOTED AS a , BODY ANGULAR ACCELERATION OF BODY ROTATION MODE 
DENOTED a . AND ANTIPHASE ARM SWING ANGULAR ACCELERATION DENOTED AS 
[i aref IS PERFORMED. 



S3120 Mztmp > Mzmax 



Mztmp 



^Mztmp < Mzmin 



DETERMINE FLOOR REACTION FORCE MOMENT 
VERTICAL COMPONENT Mz ACCORDING TO THE 
FOLLOWING EQUATION: Mz = Mzmax 
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else 



Mz = Mzmin 



Mz = Mztmp 



S3124 
S3126 



S3128 



DETERMINE ANTIPHASE ARM SWING ANGULAR ACCELERATION H a ACCORDING 
TO THE FOLLOWING EQUATION: j3 a = j3 aref + (Mz- Mztmp) /A Ma 



S3130 



DETERMINE HORIZONTAL BODY ACCELERATION a REQUIRED TO GENERATE MODEL 
MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT ABOUT DESIRED 
ZMP AT CURRENT TIME (TIME k) IF MOTION OF BODY TRANSLATIONAL MODE IS PERFORMED. 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT Fx 
WHEN HORIZONTAL BODY ACCELERATION IS a . 
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FIG.59 

(DESIRED FLOOR REACTION VERTICAL COMPONENT FOR WALKING) 
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FIG.61 

(FLOW CHART OF GAIT GENERATION PROCESS) 



INITIALIZATION (t=0, ETC.) 



S2010 



S2012 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL CYCLE). 



S2014 



S2016 



IS GAIT 
CHANGING? 



yes 



t= 0 



S2018 



S2020 



READ NEXT TIME GAITO SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAITS SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT CYCLE, AND NEXT TIME GAIT CYCLE. 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S2022 



S2024 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENT COMPONENT, INITIAL BODY POSITION/ VELOCITY, 
INITIAL BODY POSTURE ANGLE/ANGULAR VELOCITY, 
AND INITIAL ANTIPHASE ARM SWING ANGLE/ANGULAR VELOCITY) 



PROVISIONALLY DETERMINE GAIT PARAMETERS OF CURRENT TIME GAIT. 



S2026 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETERS 
(CORRECT CURRENT TIME GAIT PARAMETERS SO THAT TERMINAL 
DIVERGENT COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENT COMPONENT OF NORMAL TURNING GAIT AND 
THAT ANTIPHASE ARM SWING ANGLE CONVERGES TO ANTIPHASE 
ARM SWING ANGLE TRAJECTORY OF NORMAL GAIT.) 



S2028 



S2030 



DETERMINE PARAMETERS OF FLOOR REACTION FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE FOR COMPLIANCE CONTROL. 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF ORIGINAL GAIT 
(DETERMINE INSTANTANEOUS VALUE OF ORIGINAL GAIT SUCH THAT FLOOR REACTION 
FORCE MOMENT HORIZONTAL COMPONENT ABOUT DESIRED ZMP IS ZERO.) 



S2032 



S2034 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF CORRECTED GAIT 
(DETERMINE INSTANTANEOUS VALUE OF CORRECTED GAIT SUCH THAT MODEL MANIPULATION 
FLOOR REACTION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTICAL COMPONENT) IS 
ADDITIONALLY GENERATED ABOUT CORRECTED DESIRED ZMP WHILE CORRECTING DESIRED ZMP 
AND ANTIPHASE ARM SWING RESTORING ANGULAR ACCELERATION PATTERN TO APPROXIMATE 
TO ORIGINAL GAIT AT THE SAME TIME.) 



t=t+At 
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C END ) 
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FIG.62 



C ENTRY ^ (DETERMINATION OF INSTANTANEOUS VALUES OF CURRENT TIME GAIT) 

S2100 



DETERMINE DESIRED FLOOR REACTION FORCE VERTICAL 
COMPONENT AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



DETERMINE DESIRED ZMP AT CURRENT TIME ON 

THE BASIS OF GAIT PARAMETERS. 



S2102 



DETERMINE DESIRED POSITIONS/POSTURES OF BOTH FEET, REFERENCE BODY POSTURE 
AND REFERENCE ARM POSTURE AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2104 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION/VELOCITY 
THAT SATISFY DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT. 



S2106 



CALCULATE VERTICAL BODY POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION. 



321 08 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE 
RANGE [Fxmin,Fxmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2110 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE 
RANGE [Mztnin,Mzmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2111 



DETERMINE FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE 
RANGE [Mxymin.Mxymax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2112 



S2114 



DETERMINE MODEL MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT, 
DESIRED FLOOR REACTION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTICAL COMPONENT) 
FOR COMPLIANCE CONTROL, BODY HORIZONTAL ACCELERATION, BODY POSTURE INCLINATION 
ANGULAR ACCELERATION, AND ANTIPHASE ARM SWING ANGULAR ACCELERATION SUCH THAT 
CONDITIONS OF FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE 
RANGE, FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE, 
AND FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE ARE SATISFIED. 



S2116 



INTEGRATE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION TO 

CALCULATE HORIZONTAL BODY VELOCITY AND BODY POSTURE ANGULAR VELOCITY. 

FURTHER INTEGRATE THE RESULT TO DETERMINE HORIZONTAL BODY POSITION AND BODY POSTURE. 



S2118 



INTEGRATE ANTIPHASE ARM SWING ACCELERATION TO CALCULATE ANTIPHASE ARM SWING ANGULAR 

VELOCITY. FURTHER INTEGRATE THE RESULT TO DETERMINE ANTIPHASE ARM SWING ANGLE. 



C RETURN } 
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ENTRY 



FIG.63 

(DETERMINATION OF HORIZONTAL BODY ACCELERATION/ 
BODY POSTURE ANGULAR ACCELERATION) 

S2200 



DETERMINE DIFFERENCE IN HORIZONTAL BODY POSITION BETWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN HORIZONTAL BODY POSITION OF 
CORRECTED GAIT AND HORIZONTAL BODY POSITION OF ORIGINAL GAIT. 



DETERMINE DIFFERENCE IN BODY POSTURE INCLINATION ANGLE BETWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN BODY POSTURE INCLINATION ANGLE OF CORRECTED 
GAIT AND BODY POSTURE INCLINATION ANGLE OF ORIGINAL GAIT. 



S2202 



DETERMINE DIFFERENCE IN ANTIPHASE ARM SWING ANGLE BETWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN ANTIPHASE ARM SWING ANGLE OF 
CORRECTED GAIT AND ANTIPHASE ARM SWING ANGLE OF ORIGINAL GAIT. 



S2204 



DETERMINE REQUIRED VALUE OF MODEL HORIZONTAL BODY POSITION STABILIZATION FLOOR 
REACTION FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS OF 
DIFFERENCE IN HORIZONTAL BODY POSITION BETWEEN MODELS. 



S2206 



DETERMINE REQUIRED VALUE OF MODEL BODY POSTURE INCLINATION ANGLE STABILIZATION 
FLOOR REACTION FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS 
OF DIFFERENCE IN BODY POSTURE INCLINATION ANGLE BETWEEN MODELS. 



DETERMINE REQUIRED VALUE OF MODEL ANTIPHASE ARM SWING ANGLE STABILIZATION FLOOR 
REACTION FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS OF 
DIFFERENCE IN ANTIPHASE ARM SWING ANGLE BETWEEN MODELS. 



S2208 

S2210 
S2212 



DETERMINE MODEL HORIZONTAL BODY POSITION STABILIZATION MOMENT, MODEL BODY POSTURE ANGLE 
STABILIZATION MOMENT, MODEL ANTIPHASE ARM SWING ANGLE STABILIZATION MOMENT, HORIZONTAL 
BODY ACCELERATION, BODY POSTURE ANGULAR VELOCITY, AND ANTIPHASE ARM SWING ANGULAR 
ACCELERATION SUCH THAT THEY SATISFY RESTORING CONDITIONS. . 



MODEL MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT 

= MODEL HORIZONTAL BODY POSITION STABILIZATION MOMENT 

+ MODEL BODY POSTURE ANGLE STABILIZATION MOMENT 



S2214 



DESIRED FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT FOR COMPLIANCE CONTROL 
= COMPENSATING TOTAL FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT Mdmdxy 
+ MODEL MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT 



S2216 



DESIRED FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT FOR COMPLIANCE CONTROL 
= COMPENSATING TOTAL FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT Mdmdz 
+ FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT BALANCING WITH CORRECTED GAIT 



S2218 



RETURN 
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START 



C 



NITIALIZATION (t=0, ETC.) 



FIG.65 

(FLOW CHART OF GAIT GENERATION PROCESS) 
S3510 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL CYCLE)!] ^351 4 



SGAIT 
CHANGING? 



S3512 



S3516 yes 



t = 0 



S3518 



S3520 



READ NEXT TIME GAITtt SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAITS SUPPORTING LEG COORDINATE SYSTEM. 
CURRENT TIME GAIT CYCLE, AND NEXT TIME GAIT CYCLL 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S3522 



S3524 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENT COMPONENT, INITIAL BODY POSITION/ VELOCITY, 
INITIAL BODY POSTURE ANGLE/ANGULAR VELOCITY, AND INITIAL 
ANTIPHASE ARM SWING ANGLE/ ANGULAR VELOCITY) 



PROVISIONALLY DETERMINE GAIT PARAMETERS 
OF CURRENT TIME GAIT. 



S3526 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETERS 
(CORRECT CURRENT TIME GAIT PARAMETERS SO THAT TERMINAL 
DIVERGENT COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENT COMPONENT OF NORMAL TURNING GAIT AND 
THAT ANTIPHASE ARM SWING ANGLE CONVERGES TO ANTIPHASE 
ARM SWING ANGLE TRAJECTORY OF NORMAL GAIT.) 



S3528 



S3530 



DETERMINE PARAMETERS OF FLOOR REACTION FORCE HORIZONTAL COMPONENT 
PERMISSIBLE RANGE, FLOOR REACTION FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE, AND FLOOR REACTION FORCE MOMENT 
VERTICAL COMPONENT PERMISSIBLE RANGE FOR FULL-MODEL CORRECTION. 



S3532 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF CURRENT TIME GAIT 
(DETERMINE IT SUCH THAT DESIRED ZMP IS SATISFIED, FLOOR REACTION FORCE MOMENT 
HORIZONTAL COMPONENT DOES NOT EXCEED FLOOR REACTION FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE, AND FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT 
DOES NOT EXCEED FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE.) 



DETERMINE INSTANTANEOUS VALUES OF ZMP PERMISSIBLE RANGE, FLOOR REACTION 
FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE, AND FLOOR REACTION 
FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE FOR FULL-MODEL CORRECTION. 



S3534 



GENERATE CORRECTED GAIT USING FULL MODEL. 



S3536 



L=t+ At 



END 



S3538 
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FIG.67 

(HORIZONTAL BODY POSITION CORRECTING PERTURBATION MODEL) 
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FIG.68 

(BODY POSTURE ANGLE CORRECTING PERTURBATION MODEL) 



INERTIAL MOMENT J 
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FIG.69 

(ANTIPHASE ARM SWING ANGLE CORRECTING PERTURBATION MODEL) 
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FIG70 

FLOOR REAGION FORCE MOMENT 
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INITIALIZATION (1=0, ETC.) 
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FIG.83 

(FLOW CHART OF GAIT GENERATION PROCESS) 
S2310 



S2312 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL CYCLE). I S2314 



S2316 yes 



IS GAIT 
CHANGING? 



I 



t = 0 



]S2018 



S2320 



READ NEXT TIME GAITS SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAITS SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT CYCLE, AND NEXT TIME GAIT CYCLE. 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S2322 



S2324 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENT COMPONENT, INITIAL BODY POSITION/ VELOCITY, 
INITIAL BODY POSTURE ANGLE/ANGULAR VELOCITY, AND INITIAL 
ANTIPHASE ARM SWING ANGLE/ANGULAR VELOCITY) 



PROVISIONALLY DETERMINE GAIT PARAMETERS 
OF CURRENT TIME GAIT. 



S2326 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETERS 
(CORRECT CURRENT TIME GAIT PARAMETERS SO THAT TERMINAL 
DIVERGENT COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENT COMPONENT OF NORMAL TURNING GAIT AND 
THAT ANTIPHASE ARM SWING ANGLE CONVERGES TO ANTIPHASE 
ARM SWING ANGLE TRAJECTORY OF NORMAL GAIT.) 



S2328 



S2330 



DETERMINE PARAMETERS OF FLOOR REACTION FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE FOR COMPLIANCE CONTROL. 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF ORIGINAL GAIT 
(DETERMINE INSTANTANEOUS VALUE OF ORIGINAL GAIT SUCH THAT FLOOR 
REACTION FORCE MOMENT HORIZONTAL COMPONENT ABOUT DESIRED ZMP IS 0.) 



S2332 



S2334 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF CORRECTED GAIT 

(DETERMINE INSTANTANEOUS VALUE OF CORRECTED GAIT SUCH THAT MODEL MANIPULATION 

FLOOR REACTION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTICAL COMPONENT) IS 

ADDITIONALLY GENERATED ABOUT CORRECTED DESIRED ZMP, WHILE CORRECTING DESIRED ZMP 

AND ANTIPHASE ARM SWING RESTORING ANGULAR ACCELERATION PATTERN SO AS TO 

APPROXIMATE TO ORIGINAL GAIT AT THE SAME TIME. HOWEVER, FLOOR REACTION 

FORCE PERMISSIBLE RANGE IS CHANGED ACCORDING TO RESULT OF SLIPPAGE DETERMINATION.) 



t - t + At 



S2336 



C END ^ 



c 



ENTRY 



flG,84 

(DETERMINATION OF INSTANTAN EOUS VALUES OF CURRENT TIME GAIT) 

S5100 



DETERMINE DESIRED FLOOR REACTION FORCE VERTICAL 

COMPONENT AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS, 



DETERMINE DESIRED ZMP AT CURRENT TIME ON 

THE BASIS OF GAIT PARAMETERS. 



S5102 



DETERMINE DESIRED POSITIONS/POSTURES OF BOTH FEET, REFERENCE BODY POSTURE 
AND REFERENCE ARM POSTURE AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S5104 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION/VELOCITY 
THAT SATISFY DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT, 



S5106 



CALCULATE VERTICAL BODY POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION. 



S5108 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE 
RANGE [Fxmin,Fxmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S5110 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE 
RANGE [Mzmin,Mzmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S5112 



DETERMINE FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE 
RANGE rMxvmin.Mxvmax1 AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S5114 



S5116 



yes 



851 18 



RESULT OF SLIPPAGE 
DETERMINATION 
= IS THERE SLIPPAGE?\no 



GRADUALLY APPROXIMATE PERMISSIBLE RANGE REDUCING RATE att TO oTI 



S5120 



GRADUALLY APPROXIMATE PERMISSIBLE RANGE REDUCING RATE att T0 1~| 



MULTIPLY Fxmin, Fxmax, Mzmin, AND Mzmax BY REDUCING RATE att SO AS TO NARROVtf 
FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE AND FLOOR 
REACTION FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE RANGE. 



S5122 



S5124 



DETERMINE MODEL MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT, 
DESIRED FLOOR REACTION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTICAL COMPONENT) 
FOR COMPLIANCE CONTROL, BODY HORIZONTAL ACCELERATION, BODY POSTURE INCLINATION 
ANGULAR ACCELERATION, AND ANTIPHASE ARM SWING ANGUU\R ACCELERATION SUCH THAT 
CONDITIONS OF FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE 
RANGE, FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE, 
AND FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE ARE SATISFIED. 



INTEGRATE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION TO 

CALCULATE HORIZONTAL BODY VELOCITY AND BODY POSTURE ANGUWR VELOCITY. 

FURTHER INTEGRATE THE RESULT TO DETERMINE HORIZONTAL BODY POSITION AND BODY POSTURE. 



INTEGRATE ANTIPHASE ARM SWING ACCELERATION TO CALCULATE HORIZONTAL BODY VELOCITY 
AND ANTIPHASE ARM SWING ANGULAR VELOCITY. FURTHER INTEGRATE THE RESULT TO 
DETERMINE ANTIPHASE ARM SWING ANGLE. 



C RETURN ^ 



S5126 



S5128 



72/77 



c 



FIG.85 

(FLOW CHART OF SLIPPAGE DETERMINATION PROCESS) 



START 



SPIN DETERMINING SUBROUTINE 



S5210 



TRANSLATIONAL SLIPPAGE DETERMINING SUBROUTINE 



S5212 



SLIPPAGE VIBRATION DETERMINING SUBROUTINE 



S5214 



S5218 



S5216 



yes 



DOES DETERMINATION 
RESULT INDICATE 
PRESENCE OF SPIN 
OR TRANSLATIONALN 
SLIPPAGE OR 
SLIPPAGE VIBRATION? \no 




SLIPPAGE DETERMINATION RESULT = SLIPPAGE 



S5220 



END 



3 



SLIPPAGE DETERMINATION RESULT = NO SLIPPAGE 



73/77 



C ENTRY ^ 



FIG.86 

(FLOW CHART OF SPIN DETERMINATION PROCESS) 



DETERMINE GROUND ANGULAR VELOCITY VERTICAL COMPONENT c^supz OF 
FOOT OF THE SUPPORTING LEG ON THE BASIS OF ACTUAL BODY POSTURE 
ANGULAR VELOCITY AND JOINT ANGLE COMMAND (DETECTION VALUE). 



S5310 



DETERMINE CHANGING RATE dMsupactz/dt OF SUPPORTING LEG FLOOR 
REACTION FORCE MOMENT VERTICAL COMPONENT. 



S5312 



S5314 



yes 



oj supz I > oj e ?i 



DETERMINE APPARENT TWIST SPRING CONSTANT Ksupt 
OF SUPPORTING LEG (=(-dMsupaclz/dt)/ co supz). 



S5318 



yes 



S5316 



S5320 



Ksupt<Ksuptmin? 




SPIN DETERMINATION RESULT = SPIN 



S5322 



SPIN DETERMINATION RESULT = NO SPIN 



SPIN DETERMINATION RESULT = NO SPIN 



S5324 



( r~RETURN ^ 



74/77 



C 



ENTRY ^ 



FIG.87 

(FLOW CHART OF TRANSLATIONAL SLIPPAGE DETERMINATION PROCESS) 



S5410 



DETERMINE GROUND TRANSLATIONAL VELOCITY HORIZONTAL COMPONENT Vsupxy OF 

FOOT OF THE SUPPORTING LEG ON THE BASIS OF ACTUAL BODY POSTURE ANGULAR VELOCITY, 

DETECTION VALUE OF ACCELERATION, AND JOINT ANGLE COMMAND (DETECTION VALUE). 



DETERMINE CHANGING RATE dFsupactxy/dt OF SUPPORTING LEG 
FLOOR REACTION FORCE HORIZONTAL COMPONENT. 



S5412 



S5414 



yes 



I Vsupxy I >Ve ?i 



DETERMINE APPARENT SHEAR SPRING 
CONSTANT Ksups OF SUPPORTING 
LEG (=(-dFsupactxy/dt)/Vsupxy). 



S5416 



S5418 



S5420 



Ksups<Ksupsmin 




TRANSLATIONAL SLIPPAGE DETERMINATION RESULT 

= TRANSLATIONAL SLIPPAGE 



S5422 



TRANSLATIONAL SLIPPAGE DETERMINATION RESULT 
= NO TRANSLATIONAL SLIPPAGE 



TRANSLATIONAL SLIPPAGE DETERMINATION RESULT 
= NO TRANSL7\TI0NAL SLIPPAGE 



55424 



C RETURN ^ 



75/77 



FIG.88 

(FLOW CHART OF SLIPPAGE VIBRATION DETERMINATION PROCESS) 



ENTRY 



PASS DETECTION VALUE OF FOOT 6-AXIS FORCE SENSOR THROUGH 
BAND-PASS FILTER TO EXTRACT SLIPPAGE VIBRATION COMPONENT 



S5512 



S5510 



S5514 



yes 



^ MAGNITUDE OF SLIPPAGE 
VIBRATION 

COMPONENT I > Ampe? 




SLIPPAGE VIBRATION DETERMINATION RESULT 
= SLIPPAGE VIBRATION 



S5516 



SLIPPAGE VIBRATION DETERMINATION RESULT 
= N0 SLIPPAGE VIBRATION 



RETURN ^ 



76/77 



FIG.89 



DETERMINATION OF SLIPPAGE 



YES 
NO- 



REDUCING RATE att 



0- 



ORIGINAL FLOOR 
REACTION FORCE 
PERMISSIBLE RANGE 




FINAL FLOOR REACTION 
FORCE PERMISSIBLE 
RANGE (ORIGINAL FLOOR 
REACTION FORCE 
PERMISSIBLE RANGE* att) 






-►t 



-I- 1 1 t ► 



C START ^ 



FIG.90 



77/77 

(FLOW CHART OF GAIT GENERATION PROCESS) 



NITIALIZATION (t=0, ETC.) 



S3610 



S3612 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL CYCLE)] S3614 



S3616 yes 



IS GAIT 
CHANGING? 



I 



{ = 0 | S3618 



S3620 



READ NEXT TIME GAIT3 SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAITS SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT CYCLE, AND NEXT TIME GAIT CYCLE. 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S3622 



S3624 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENT COMPONENT, INITIAL BODY POSITION/ VELOCITY, 
INITIAL BODY POSTURE ANGLE/ANGULAR VELOCITY, 
AND INITIAL ANTIPHASE ARM SWING ANGLE/ANGULAR VELOCITY) 



PROVISIONALLY DETERMINE GAIT PARAMETERS OF CURRENT TIME GAIT. 



S3626 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETERS 
(CORRECT CURRENT TIME GAIT PARAMETERS SO THAT TERMINAL 
DIVERGENT COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENT COMPONENT OF NORMAL TURNING GAIT AND 
THAT ANTIPHASE ARM SWING ANGLE CONVERGES TO ANTIPHASE 
ARM SWING ANGLE TRAJECTORY OF NORMAL GAIT.) 



S3628 



S3630 



DETERMINE PARAMETERS OF FLOOR REACTION FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE FOR COMPLIANCE CONTROL. 



SUBROUTINE FOR DETERMINING SLIPPAGE AND PERMISSIBLE RANGE REDUCING RATE att 



S3632 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF ORIGINAL GAIT 
(DETERMINE INSTANTANEOUS VALUE OF ORIGINAL GAIT SUCH THAT FLOOR REACTION 
FORCE MOMENT HORIZONTAL COMPONENT ABOUT DESIRED ZMP IS ZERO.) 



S3634 
S3636 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF CORRECTED GAIT 
(DETERMINE INSTANTANEOUS VALUE OF CORRECTED GAIT SUCH THAT MODEL MANIPULATION 
FLOOR REACTION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTICAL COMPONENT) IS 
ADDITIONALLY GENERATED ABOUT CORRECTED DESIRED ZMP WHILE CORRECTING DESIRED ZMP 
AND ANTIPHASE ARM SWING RESTORING ANGULAR ACCELERATION PAHERN TO APPROXIMATE 
TO ORIGINAL GAIT AT THE SAME TlMEj 



t=t+ At 



S3638 



C END ^ 



